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ABSTRACT 


Traditionally  path  planning  software  has  been  developed  in  LISP  or  C.  >^th  the  recent 
government  mandate  for  the  use  of  Ada,  this  thesis  seeks  to  demonstrate  the  feasibility  of 
using  Ada  for  both  path  preplanning  and  real-time  path  replanning.  Land  vehicle  path 
planning  can  be  accomplished  with  two  horizontal  components.  However,  for  autonomous 
underwater  vehicles,  the  two  horizontal  components  and  a  vertical  component  are  required. 
Memory  and  computational  speed  restrictions  dictate  that  special  processing  of  the  search 
space  be  conducted  to  optimize  the  time-space  trade-off.  In  this  research,  a  four 
dimensional  array  of  nodes  (two  horizontal  components,  one  vertical  component  and  one 
orientation  component)  is  used  to  represent  the  search  space.  By  use  of  an  orientation 
component,  the  number  of  nodes  that  can  be  legally  moved  to  is  limited,  in  effect  pruning 
the  search  space.  Three  search  methods  were  investigated:  the  Tendril  search,  the  Direction 
search  and  the  Real-time  A*  search.  The  Tendril  search  is  a  wavefront,  breadth-first  search. 
The  Direction  search  uses  a  vector  field  for  path  planning.  The  Real-time  A"*  search  uses 
the  Tendril  search  to  a  specified  search  depth  then  applies  a  heuristic  to  determine  the  best 
path  to  expand  upon. 
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L  INTRODUCTION 


Autonomous  underwater  vehicle  (AUV)  research  continues  to  grow  as  more 
applications  are  devised.  From  industry  and  scientific  research  to  military  applications, 
AUV  technology  has  generated  great  interest  Currently,  there  are  nearly  30  different 
organizations  researching  AUV  technology,  of  which  18  are  government  funded  [Busby 
and  Vadus,  90].  This  indicates  the  strong  interest  the  government  has  in  this  technology. 

The  benefits  provided  by  uiunanned  autonomous  vehicles  are  many.  They  provide  a 
means  to  accomplish  missions  which  are  considered  too  dangerous  for  human  involvement 
[Qoutier  90].  “Progress  is  aimed  toward  minimizing  need  for  man’s  physical  presence, 
intervention  underwater”  [Busby  and  Vadus  90].  Underwater  vehicles  can  be  categorized 
as  either  tethered  or  autonomous  [Rogers  89].  In  contrast  to  a  remotely  operated  vehicle 
(ROV),  an  AUV  is  not  restricted  by  an  umbilical  which  can  hinder  task  performance  in 
some  cases. 

Due  to  the  AUV’s  nature,  mission  planning  and  execution  are  very  complex  problems 
to  solve.  Accurate  world  models  must  be  made  and  complex  path  planning  performed  prior 
to  mission  execution.  During  task  performance,  continued  evaluation  of  the  many  aspects 
of  the  mission  must  be  performed.  If  necessary,  adjustment  or  replarming  must  be 
conducted  to  insure  successful  mission  completion  or  a  decision  to  abort 

A.  OBJECTIVES 

This  thesis  intends  to  focus  on  path  planning  and  replarming  using  the  Ada 
programming  language  [Healey  90].  Several  ob^ctives  are  listed  below: 

1.  Implement  a  multi-dimensional  Tendril  search  in  Ada. 

2.  Investigate  the  feasibility  of  waypoint  utilization. 

3.  Implement  a  Real-time  A*  (RTA*)  path  replanner  in  Ada. 

4.  Investigate  the  feasibility  of  a  vector  Held  method  of  path  planning. 


5.  Examine  the  feasibility  of  utilizing  Ada  reusable  modules. 


B.  BACKGROUND 

1.  Naval  Postgraduate  School  AUV  n  (NPS  AUV II) 

The  basic  component  layout  of  the  NPS  AUV  n  is  illustrated  in  Figure  1-1.  It  is 
of  aluminum  box  construction  with  a  16”  beam,  10”  height,  92”  length  and  displaces  390 
pounds  [Gouder  90].  It  uses  eight  independent  control  surfaces,  four  tunnel  thrusters  and 
two  main  screws,  and  has  a  top  speed  of  two  knots  (three  feet  per  second)  with  a  20  feet 


NPS AUV n 
Figure  1-1 
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turning  diameter.  Power  is  provided  by  on-board  lead-acid  batteries  with  an  approximate 
two  and  one  half  hour  operating  time  [Royd  91].  Current  on-board  systems  include  a 
GESPAC  MPU  20HF  board  with  Motorola  68020  and  68882  processors.  OS  -  9  was 
chosen  as  the  operating  system  for  its  multi-tasking  capabilities.  As  recommended  by 
Bihari,  a  full  GESPAC  suite  is  expected  to  be  used  for  its  suitability  to  AUV  applications 
[Bihari  90].  Appendix  A  and  B  are  Data  Flow  Diagrams  (DFD)  and  Software  Heirachy  for 
this  project. 

2.  Mission  Planning  Expert  System 

The  mission  planning  Expert  System  (MPES)  is  hosted  on  a  Symbolics  3675 
LISP  machine.  Using  the  KEE  expen  system  shell,  it  has  four  major  components:  the 
Mission  Receiver,  Mission  Planner,  Mission  Constructor  and  Mission  Executor.  The 
Mission  Receiver  acts  as  the  interface  agent  for  user  input  This  information  is  passed  to 
the  Mission  Planner  which  decides  which  path  planning  algorithm  is  best  suited  for  the  user 
supplied  circumstances.  Using  various  search  technique  including  A*,  and  best-first  search, 
the  Mission  Constructor  does  the  actual  path  planning.  The  Mission  Executor  interfaces 
with  the  AUV/simulator  and  provides  the  appropriate  mission  data  for  execution.  Figure  1- 
2  illustrates  the  MPES  structure.  [Ong  90] 

3.  NFS  AUV  Simulator 

The  NPS  AUV  D  simulator  contains  a  full  set  of  submarine  motion  and 
hydrodynamics  equations  providing  accurate,  real-time  simulation.  Implemented  on  a  SGI 
IRIS  4D/240  GTX  graphics  workstation,  it  displays  a  detailed  underwater  mapping  of  the 
Monterey  Bay.  Variable  terrain  resolution  is  used  automatically  to  allow  real-time 
operations.  Its  development  is  a  joint  effort  between  the  computer  science  and  mechanical 
engineering  departments  at  the  Naval  Postgraduate  School.  [Jurewicz  90] 
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C.  THESIS  ORGANIZATION 

Chapter  II  reviews  previous  and  current  work  in  AUV  technology.  A  detailed  look  at 
various  path  planning  techniques  is  provided. 

Chapter  m  introduces  the  Tendril  search.  The  original  two  dimensional  and  the 
expanded  four  dimensional  version  in  LISP  are  examined  Several  learning  points  hnom  the 
task  of  translating  the  LISP  program  to  Ada  are  reviewed  Limiting  features  of  the  four 
dimensional  Tendril  search  are  presented  as  well  as  a  look  into  the  feasibility  of  the  Tendril 
bidirection  search  (TBS). 

Chapter  IV  presents  a  vector  field  approach  to  path  planning  with  a  discussion  of 
advantages  and  disadvantages. 

Chapter  V  presents  a  real-time  path  rt  'anner  using  the  Real-time  A*  Search  (RTA*). 
Many  questions  are  posed  and  plausible  justification  for  the  use  of  the  RTA*  is  presented 

Chapter  VI  provides  conclusions  and  recommendations  for  further  research.  Heavy 
emphasis  is  placed  on  the  recommendations,  which  provide  good  insight  to  the  perceived 
goals  of  the  NPS  AUV  research. 
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Figure  1>2  Mission  Planner  Program  Diagram 


n.  AUTONOMOUS  UNDERWATER  VEHICLE  RESEARCH 

A.  VEHICLE  ARCHITECTURE 

1.  Texas  A&M 

Texas  A&M  University  has  made  major  contributions  to  AUV  technology 
conducting  feasibility  research.  Reliability  and  fault  tolerance  were  the  primary  concerns, 
and  no  vehicle  construction  was  intended.  To  accommodate  this,  16  Sun  Sparc  stations, 
fully  distributed,  were  used  (fully  loosely  coupled).  [Qoutier  90] 

Programmed  in  the  C  language,  it  incorporated  nine  embedded  knowledge  based 
systems  (KBS).  Some  important  findings  resulted  from  this  research.  The  use  of  a  “watch 
team”  knowledge  base  (KB)  was  overly  centralized.  This  KB  simulated  the  tasks  and  duties 
performed  by  a  human  team  aboard  Navy  submarines.  By  its  centralized  nature,  results  and 
decisions  were  predictable,  however,  flexibility  was  reduced.  There  is  a  trade-off  between 
flexibility  and  predictability  which  must  be  clo»tly  considered  [Cloutier  90]. 

2.  Naval  Ocean  Systems  Center  (NOSC) 

NOSC  pioneered  AUV  research  in  the  1980’s  after  extended  involvement  with 
remotely  operated  vehicle  (ROV)  research  since  the  1960’s.  NOSC  has  several  on-going 
research  efforts.  Advanced  unmanned  search  system  (AUSS)  was  developed  for  search  and 
survey.  The  friee-swimming  mine  neutralization  vehicle  (FSMNV)  is  also  under 
development.  [Busby  and  Vadus  90] 

3.  Massachusetts  Institute  of  Technology  (MIT) 

The  Massachusetts  Institute  of  Technology  developed  Sea  Squirt  with  funding 
from  the  National  Oceanic  &  Atmospheric  Administration  and  in  coopoation  with  Draper 
Labs.  It  is  a  light  weight,  low-cost  AUV  primarily  used  as  a  test  platform  for  intelligent 
algorithms.  The  research  goal  is  to  make  a  vehicle  capable  of  operations  in  an  adaptive 
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manner  with  respect  to  its  environment  in  an  uncharted  area  [Busby  and  Vadus  90]. 
Onboard  systems  include  a  GESPAC  MPU  -  20  board  with  a  Motorola  68020  cpu  and  runs 
OS  -  9,  like  the  NPS  AUV  D  [Bellingham  90]. 

4.  Defense  Advance  Research  Projects  Agency 

The  Defense  Advance  Research  Projects  Agency  (DARPA)  has  been  actively 
involved  in  AUV  research.  It  has  provided  about  90%  of  the  research  funding  throughout 
the  research  community  and  industry.  As  early  as  1988,  DARPA  initiated  projects  with 
Draper  Laboratory  and  Martin  Marietta.  These  projects  focused  on  the  research  and 
development  of  two  vehicles  and  intelligence  task  research.  Martin  Marietta  also  plaimed 
to  develop  a  “hard  time"  aspect  to  navigation  that  entailed  planning  a  path  where  arrival 
times  at  specific  way  points  are  known  before  hand  and  met  during  execution.  In  1989 
DARPA  in  conjunction  with  Lockheed  Missiles  and  Space  Company  began  development 
of  an  autonomous  mine  avoidance  vehicle.  [Busby  and  Vadus  1990] 

5.  International  Submarine  Engineering 

Over  the  years.  International  Submarine  Engineering,  Ltd.  GSE)  has  developed 
several  unmanned  underwater  vehicles  (UUV).  Its  DOLPHIN  was  a  diesel  powered  vehicle 
designed  for  offshore  hydrographic  mapping.  The  interesting  aspect  of  this  vehicle  is  the 
use  of  GESPAC  components.  After  an  extensive  market  survey,  GESPAC  was  chosen  for 
its  price,  performance,  size,  ruggedness  and  availability.  [Zheng  et.  al.  90] 

B.  PATH  PLANNING 

1.  General  Path  Planning 

The  ultimate  goal  of  a  path  planner  is  to  derive  a  continuous  set  of  ftee  space 
points  from  the  starting  position  to  the  goal  position  [Latombe  91].  Fmr  control  of 
autonomous  vehicles  this  can  be  done  at  various  levels  of  resolution.  A  route  planner  is 
used  at  low  resolution  and  a  path  planner  provides  a  more  specific  solution  to  the  path 
planning  problem.  In  essence,  the  path  planner  provides  a  detailed  path  for  the  various  path 


segments  generated  by  the  route  planner  [Ong  90].  This  thesis  concentrates  on  the  path 
planning  resolution. 

Path  planning  is  a  well  researched  topic  with  many  search  techniques  being  used 
in  various  research  efforts.  Most  commonly  used  methods  are;  Breadth-first,  A*,  Hill 
climbing,  Depth-first  and  Best-first  Some  of  these  will  be  presented  later  in  this  chapter. 

Important  to  note  is  the  complexity  of  the  search  methods.  As  search  space 
increases,  some  techniques,  especially  exhaustive  methods,  tend  to  be  restrictive  either  due 
to  memory  or  time  requirements.  Branching  factor  is  an  important  aspect  to  consider.  In  a 
two  dimensional  search  space  there  may  be  as  many  as  eight  adjacent  nodes  that  the  vehicle 
can  legally  move  to  as  illustrated  in  Figure  2-1.  With  the  addition  of  a  third  dimension  these 
legal  moves  increase  to  26  as  illustrated  in  Figure  2-2.  Methods  are  required  to  sufficiently 
reduce  the  branching  factor  to  make  these  techniques  viable.  [Ong  90] 

2,  Fast«  Three-dimensional*  Collision-free  Motion  Planning 

a.  General  Description 

Implemented  in  a  nodal  search  space  representation,  this  method  successively 
divides  the  search  space  into  homogeneous  octrees  or  to  a  set  resolution  limit  (section  b 
below  provides  more  detail  on  octrees).  The  less  node  division  that  is  necessary,  the  easier 
for  the  path  planner  to  process  the  search  space.  It  is  evident  that  planning  a  path  in  a  search 
space  with  a  small  number  of  nodes  is  easier  than  to  do  so  in  a  search  space  with  a  large 
number  of  nodes.  [Herman  86] 

b.  World  Representation 

Upon  initialization,  the  world  is  represented  as  a  single  node.  If  the  node  is 
not  homogeneous  (either  wholly  obstacle  or  free  space)  it  is  divided  into  eight  children 
nodes.  Each  new  node  is  evaluated  for  homogeneity  and  if  necessary  divided  further.  This 
process  continues  until  all  nodes  are  either  wholly  obstacles  or  free  space,  or  the  resolution 
limit  is  reached.  A  tree  structure  is  formed  with  the  original  node  as  the  parent  and  the 
resulting  octree  nodes  as  the  children. 
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Figure  2-1  Two  Dimensional  Legal  Moves 


Figure  2-2  Three  Dimensional  Legal  Moves 
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c.  Search  Techniques 

Several  search  methods  were  incorporated  in  this  method,  to  optimize  time 
and  memory  use: 

1.  Hypothesis  and  Test, 

2.  Hill  Climbing, 

3.  A*. 

The  process  started  with  the  hypothesis  and  test  method  and  switched  to  the  hill  climbing 
method.  When  local  maxima  were  encountered  the  A*  process  was  used  to  overcome  them. 
Once  past  the  local  maxima,  the  program  continued  with  the  hiU  climbing  process. 

d.  Conclusions 

It  is  important  to  note  that  this  n^thod  may  not  find  the  minimal  cost  path  and 
only  finds  an  adequate  cost  path.  This  may  or  may  not  be  sufficient  for  some  path  planning 
needs. 

Another  consideration  is  the  use  of  several  methods  for  path  determination. 
The  advantage  of  using  multiple  methods  is  to  avoid  “traps”  such  as  local  maxima  that 
could  stop  a  search  from  finding  a  path  to  the  goal  where  one  exists.  Other  individual 
methods  may  not  encounter  local  maxima  “traps”  but  may  be  time  restrictive.  Thus  for 
timing  considerations  a  less  exhaustive  method  is  used  and  the  “traps”  must  be  considered. 
By  making  this  time  trade-off,  other  methods  are  required  where  one  method  may  fail. 
Although  acceptable,  using  multiple  methods  adds  to  the  complexity  of  the  problem  and 
appears  to  provide  little  overall  advantage  in  computational  speed. 

3.  Bidirectional  Staged  Heuristic  Search  (BS*) 

a.  General  Description 

This  technique  can  use  any  of  the  basic  methods  listed  in  the  first  paragraph 
of  this  chapter.  What  makes  this  approach  unique  is  how  that  basic  method  is  used.  BS*  is 
actually  two  searches:  one  starting  at  the  starting  point  and  woridng  towards  the  goal,  the 
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other  starting  at  the  goal  and  working  towards  the  starting  point.  After  each  iteration  a 
“wave”  of  acceptable  moves  is  generated  for  each  search.  When  the  two  waves  meet  at  a 
connecting  point  a  path  from  the  starting  point  to  the  goal  is  completed.  Figure  2-3 
illustrates  the  BS*.  [Kwa  89] 


Wave  front  for  START  to  GOAL  search 


Figure  2-3  Bidirectional  Search  Process 


b.  Trees 

As  the  search  expands  on  a  node  finding  its  subsequent  legal  nK>ves,  a  tree¬ 
like  structure  is  generated.  Here  the  branching  factor  becomes  a  problem:  the  trees  grow 
exponentially.  Various  methods,  like  pruning  and  trimming  have  been  used  to  reduce  the 
size  of  the  trees  and  provide  more  efficient  processing.  It  has  been  proposed  that  generating 
two  trees,  vice  one,  reduces  the  total  effort  of  processing  the  search  space.  Therefore,  by 
dividing  the  search  process  into  two  halves  (start-to-goal,  and  goal-to-start)  the  trees 
generated  are  overall  smaller  than  that  generated  by  a  single  direction  search.  [Kwa  89] 

c.  Cost 

With  the  reduction  of  tree  size  and  search  space,  it  would  be  logical  to  assume 
the  process  to  require  less  time  to  generate  a  path.  This,  however,  is  not  the  case.  After  each 
iteration  a  check  must  be  made  to  determine  if  the  two  search  halves  have  met  This  check 
can  be  a  costly  process  and  may  not  reduce  overall  computational  time. 

Other  researchers  have  tried  to  “push”  or  “nudge”  the  search  tree  growth 
along  an  expected  path  and  thereby  reduce  the  number  of  “open”  nodes.  This,  however,  can 
lead  to  a  non-admissable  solution  to  the  problem  and  a  less  then  optimal  path  may  be 
generated.  Kwa  uses  nipping,  pruning,  trimming  and  screening  to  help  reduce  the  number 
of  open  nodes  and  reduce  run-time.  Nipping,  pruning,  trimming  and  screening  are 
techniques  used  to  eliminate  paths  that  are  obviously  too  costly. 

d.  Advantages  and  Disadvantages 

The  most  noteworthy  advantage  is  that  this  method  can  be  executed  on  a 
parallel  processing  computer.  With  a  multi-processor  system  such  as  the  T-800  transputer, 
each  processor  could  perform  a  search.  Taking  this  one  step  further,  consider  a  path  with 
an  intermediate  way-point  as  indicated  in  Figure  2-4.  A  multi-processor  system  could 
process  each  path  segment  (start-to-waypoint,  waypoint-to-start,  goal-to-waypoint, 
waypoint-to-goal)  on  different  processors.  The  same  problem  of  checking  for  the 
connecting  point  is  still  unavoidable. 
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4.  Conflguration  Space  (C>space) 

a.  General  Description 

The  underlying  assumption  of  C-space  path  planning  is  that  it  is  easier  to  plan 
for  a  point  size  vehicle  then  for  a  rigid  body  vehicle.  By  reducing  the  vehicle  representation 
to  a  point,  the  world  model  must  be  altered  so  that  a  safe  path  can  be  planned.  How  the 
world  is  changed  is  the  interesting  aspect  of  this  technique.  [Warren  90] 

b.  C-Space  Obstacles 

Since  the  rigid  body  vehicle  is  represented  as  a  point  something  must  be  done 
to  insure  a  safe  path  is  planned  [Lozano-Perez  83].  To  accomplish  this,  obstacle  size  is 
altered  to  reflect  a  vehicle  size  buffer  as  shown  in  Figure  2-5  [Latombe  91].  It  is  important 
to  note  that  obstacle  buffer  size  varies  depending  on  the  vehicle  orientation.  Each 
orientation  specific  obstacle  is  called  a  shield  and  can  be  calculated  at  run-time  to  reduce 
preprocessing  workload.  [Latombe  91] 

c.  Conclusion 

C-space  obstacle  representation  may  be  good  where  very  precise  navigation 
is  necessary.  Calculations  for  vehicle  representation  are  reduced  by  representing  the 
vehicle  as  a  point  but  computational  time  is  increased  by  the  requirement  for  calculating 
the  shields  for  each  orientation.  The  four-dimensional  Tendril  search  uses  a  very  simplified 
C-space  concept.  Orientation  is  limited  to  the  four  cardinal  headings  and  each  node  is 
represented  by  four  shields. 

5.  Potential  Field 

a.  General  Description 

Given  a  girded  or  nodal  search  space,  potentials  are  assigned  to  each  node. 
These  potentials  are  based  upon  proximity  of  a  node  to  the  goal  or  an  obstacle.  Nodes  with 
obstacles  in  close  proximity  will  have  a  repulsion  potential  since  it  is  undesirable  to 
position  a  vehicle  in  these  nodes.  Other  nodes  provide  a  free  and  clear  path  to  the  goal  and 
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thus  are  assigned  an  attraction  potential.  Once  the  potential  Held  is  established  any  search 
technique  can  be  used  to  find  the  least  cost  path.[Warren  90] 


Figure  2>5  Expanded  C*Space  Obstacle  for  a  Vehicle  with  Fixed  Orioitation 


b.  World  Representation 

Figure  2-6  shows  how  a  potential  field  can  be  represented.  Ree  space  is 
assigned  a  potential  based  on  the  square  of  the  distance  from  the  goal.  Nodes  near  obstacles 
are  assigned  a  potential  based  on  the  reciprocal  of  the  distance  from  the  obstacle,  squared. 
After  preprocessing  the  search  space,  assigning  potentials,  a  topology  or  landscape  is 
developed  that  allows  a  vehicle  to  travel  “downhill”  to  the  goal.[Warren  90] 
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c.  Conclusion 

Again,  local  maxima  can  cause  a  problem  by  “trapping”  the  search.  Figure  2- 
6  displays  this  and  indicates  the  need  for  an  alternate  search  method.  In  the  figure,  the 
shortest  path  would  be  along  the  diagonal  between  the  start  and  goal.  The  potentials, 
however  may  drive  the  path  in  a  less  optimal  direction  or  worse;  trap  the  path  at  the  local 
maxima.  The  Direction  search  incorporates  the  potential  field  concept  at  a  very  abstract 
level.  Values  are  not  assigned  to  each  node,  however,  a  “pointer”  to  the  next  node  in  the 
shortest  path  to  the  goal  is  stored  at  each  node  in  the  search  space. 

6.  Remarks 

Each  of  the  techniques  presented  have  been  researched  well  and  the  use  of 
multiple  methods  has  been  explored,  yet  combination  of  techniques  in  a  single  search  is 
somewhat  rare.  Each  has  its  merit  and  could  easily  be  incotporated  in  varying  degrees  of 
complexity  to  produce  an  efficient  path  planner.  The  search  techniques  to  be  presented  in 
the  following  chapters  use  some  variation  of  these  techniques.  The  predominant  difference 
from  previous  research  is  that  some  of  these  techniques  are  combined  into  a  single  search 
process. 
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Figure  2-6  Example  Potential  Field  Representation 
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m.  THE  TENDRIL  SEARCH 


A.  GENERAL 

In  the  Tendril  search,  the  search  space  is  represented  by  an  muld-dimensional  array, 
OT  lattice  of  nodes.  Each  node  maintains  several  attributes  to  facilitate  the  path  planning 
process.  One  of  the  attributes  is  a  list  of  the  node’s  immediate  neighbors,  with  an  associated 
cost  to  move  to  each  neighbor.  Only  non-obstacle  neighbors  are  maintained  in  this  list  and 
represent  the  legal  moves  that  can  be  made  from  the  node.  The  legal  moves  from  the 
starting  point  represent  the  first  WAVE.  Legal  moves  are  found  for  each  node  of  this 
WAVE  and  the  process  continues  generating  subsequent  waves  until  the  goal  is  reached. 

B.  LISP  VERSION 

1.  Two  Dimenskmal  Problem 

Originally  written  for  a  two  dimensional  search  space  [McGhee  90],  there  are 
eight  potential  legal  moves  (raie  for  each  cardinal  dutction  and  one  for  each  diagmial 
move)  that  can  be  made  from  die  starting  point  These  legal  moves  are  placed  in  an  “open” 
list  WAVE,  of  nodes  to  be  expanded  upon.  The  next  wave  is  determined  by  finding  the 
legal  moves  for  each  node  in  the  WAVE  list  As  each  node  is  processed  it  is  assigned  a 
tendril  length  representing  the  length  of  the  current  path  from  the  start  to  diat  specific  node. 
There  is  an  exponential  increase  in  the  number  of  nodes  for  each  wave  which  could  cause 
limitations  due  to  memory  requirements.  Since  individual  nodes  can  be  reached  via 
multiple  paths,  it  is  important  to  consider  each  one  so  the  shortest  can  be  selected.  By 
pruning  previously  processed  nodes  whose  assigned  tendril  length  is  less  than  that  of  the 
current  waves  calculation  for  the  tendril  length,  the  longer  and  redundant  pafris  are 
eliminated.  This  specifies  that  the  node  can  be  reached  by  a  shorter  path  and  the  cuirent  path 
need  not  be  investigated.  The  pruning  process  helps  to  reduce  the  time  required  to 
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preprocess  the  search  space.  Even  so,  preprocessing  of  the  search  space  for  each  node’s 
legal  successor  is  not  feasible,  especially  for  real-time  constraints. 

2.  Four  Dimensional  Problem 

When  a  third  dimension  (depth)  is  considered,  the  problem  becomes  very 
complex.  Each  node  has  26  possible  legal  moves.  This  is  unacceptable  if  real-time  path 
planning  is  needed.  To  reduce  this  number  an  additional  dimension  is  considered,  heading. 
It  is  not  unreasonable  and  is  only  natural  to  consider  orientation  when  planning  a  path.  Only 
the  cardinal  headings  (North,  East,  West  and  South)  are  considered  in  this  program.  Since 
a  vehicle  must  have  a  heading  the  number  of  legal  moves  can  be  reduced  to  nine  as  shown 
in  Figure  3-1.  Thus  the  two  dimensional  problem  is  easily  expanded  to  four  dimensions 
with  little  increase  in  computational  complexity.  More  details  of  this  program  are  found  in 
[Bonsignore  90].  Appendix  C  lists  the  four  Dimensional  LISP  code  (3dh.li^). 

C.  ADA  VERSION  DESCRIPTION 

1.  General 

"Why  use  Ada?”  is  a  question  surely  posed  by  some  researchers.  Through  a  recent 
mandate,  the  government  requires  the  use  of  Ada  for  its  software  projects.  This,  however, 
is  not  the  driving  force  behind  the  use  of  Ada  for  this  thesis.  Ada  was  designed  for  use  in 
large  programming  projects.  With  characteristics  such  as  separate  conipilation  and  generic 
procedures,  it  facilitates  the  modularization  of  programming  projects  and  allows  several 
programmers  to  work  individually.  Modularity  also  helps  with  program  maintainability. 
Ada  provides  multitasking  and  timing  constructs  which  facilitate  real-time  systems 
programming  [Voltz,  et  al  84].  All  of  these  attributes  make  Ada  especially  suitable  for 
AUV  programming. 

The  initial  intent  of  this  thesis  was  to  build  a  path  planner  with  Ada  reusable  code. 
Some  difficulties  with  reusable  code  were  encountered.  The  Ada  software  repository  at 
White  Sands  Missile  Range  is  not  quite  "user  fnendly”.  Very  general  procedures,  such  as 
building  linked  lists,  were  acceptable.  More  sophisticated  code,  however,  was  often 
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difficult  to  find.  Some  of  these  procedures  were  not  stored  with  “user  friendly”  file  names 
and  often  stored  with  coded  names,  making  quick  access  difficult  Even  when  the 
appropriate  code  was  obtained  and  the  module  found  to  be  usable,  many  modifications 
were  required.  On  large  projects  these  modifications  and  subsequent  testing  may  be  more 
costly  then  writing  the  procedures  from  scratch  [Gaffney  89].  For  these  reasons  this  thesis 
does  not  take  advantage  of  reusable  Ada  software. 

2.  Direct  Translation 

An  initial  attempt  at  programming  in  Ada  was  made  by  making  a  direct 
translation  from  LISP.  All  the  LISP  structures  and  functions  were  translated  into  Ada 
records  and  procedures.  This  task  was  not  easy  since  the  two  languages  are  very  different 
Many  modifrcations,  although  small,  were  required  in  the  Ada  code  due  to  these  language 
diffoences. 

a.  Memory  Problem 

A  major  difficulty  with  the  direct  translation  was  that  of  memory  usage.  The 
LISP  version  preprocesses  the  search  space  assigning  a  list  of  possible  legal  moves  from 
each  node.  In  a  two  dimensional  problem  there  are  eight  legal  moves  for  each  node  (the  test 
search  space  is  a  10  x  20  array  resulting  in  approximately  16(X)  legal  moves).  The  memory 
requirement  for  this  can  be  too  large  for  some  systems  (as  was  the  case  for  a  modestly 
configured  386SX).  Preprocessing  is  wasteful  since  nodes  that  do  not  require  processing 
were  processed  anyway.  These  problems  were  solved  by  modification  in  the  Ada  version 
which  will  be  presented  in  subsequent  sections  of  this  chapter. 

b.  Speed 

Due  to  the  extensive  search  process  requirements,  the  speed  at  which  the 
LISP  version  ran  was  slow.  The  directly  translated  Ada  version  did  not  run  at  all  due  to 
system  memory  constraints,  therefore  no  timing  characteristics  are  available. 
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3.  Four  Dimensional  Problem 

Expanding  the  two  dimensional  problem  to  incorporate  depth  and  heading 
drastically  increased  memory  requirements  since  the  number  of  legal  moves  over  tripled 
resulting  in  a  combinatorial  explosion.  As  earlier  stated,  this  was  solved  by  considering 
(Mily  those  moves  that  the  vehicle  can  immediately  transition  to  when  the  vehicles  heading 
is  taken  into  account  By  considering  orientation  in  the  search  process  urmecessary  path 
searches  were  eliminated. 

4.  Modifications 

Many  modifications  were  required  to  enable  the  four  dimensional  Ada  Tendril 
search  to  run.  Some  changes  were  very  simple  and  others  required  a  complete  rewrite  to 
achieve  the  efficiency  required.  Appendix  D  is  a  data  dictionary,  DFD,  and  code  for  this 
process. 

a.  Smatter  records 

The  LISP  version  record  structure  for  a  node  maintained  a  list  of  all  legal 
moves  possible  from  that  node.  By  eliminating  this  attribute  the  sue  of  the  record  was 
substantially  reduced  thus  easing  the  limitatitms  imposed  by  memory  restrictions.  Section 
b.  below  describes  how  the  legal  moves  are  detomined. 

b.  **F_MOVES” 

To  reduce  memory  requirements  the  preprocessing  of  the  search  space  was 
eliminated.  Instead,  the  legal  moves  were  determined  as  each  node  was  reached  in  the 
search  process.  Thus  if  looking  for  a  path  between  two  adjacent  nodes  the  legal  moves  for 
the  nodes  far  removed  from  the  possible  path  are  not  determined.  Listed  below,  is  the 
pseudo-code  representation  of  this  process. 

procedure  F.MOVES  (N_ARRA Y ;  in  out  NODE_ARRA Y; 

ROOT  :  in  out  UST.PTR)  is 
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HEADING  ;INT_TYPE:=ROOT.LOC(4); 


begin 

case  HEADING  is 
when  the  heading  is  nQrth=> 
check  the  upper  northwest  node 
check  the  upper  north  node 
check  the  upper  northeast  node 
check  the  nt^west  node 
check  the  north  node 
check  the  northeast  node 
check  the  lower  northwest  node 
check  the  lower  north  node 
check  the  lower  northeast  node 
when  heading  east  => ... 
when  heading  south  =>... 
when  heading  west  =>... 
when  others  => 
null; 

end  case; 
endF_MOVES; 

procedure  F.PATH  (N.ARRA Y :  in  out  NODE.ARRAY)  is 
ROOT  :  LIST_PTR  :=  WAVE; 
begin 

while  the  toot  contains  valid  information  lo(^ 

F_MOVES  (N_ARRAY,  ROOT); 

ROOT  :=  WAVE.NEXT; 
end  loop; 

if  the  goal  is  found  then 
return  to  the  main  process  (DOlSEARCH) 
end  if; 

endF_PATH; 


F.MOVES,  called  from  within  F.PATH,  takes  as  input  the  search  space  (N.ARRAY)  and 
the  current  node  being  processed  (ROOT).  Using  the  ROOT’S  heading  the  nine  legal  moves 
ate  determined.  Each  tegal  move  is  ptxxressed  and  if  the  GOAL  is  among  them,  the  search 
is  complete,  otherwise  they  are  assigned  m  a  list  called  WAVE.  The  legal  moves  for  each 
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node  in  WAVE  are  then  generated  and  the  process  of  checking  for  GOAL  is  repeated  This 
continues  until  the  goal  is  found  or  all  nodes  are  processed  without  reaching  the  GOAL. 


c.  Waypoint  capaWity 

It  is  conceivable  that  an  AUV  may  need  to  navigate  to  some  intermediate 
points  that  may  not  be  along  the  optimal  path  between  the  start  and  goal.  For  this  leastnt  a 
waypoint  capability  is  required  The  algorithm  below  illustrates  the  TENDRILWP  search 
in  pseudo-code  which  allows  multiple  waypoint  path  generation. 


procedure  TENDRILWP  is 
begin 

GET  DATA; 

DO.SEARCH; 
end  TENDRILWP 

procedure  GET_DATA  is 

tiiere  are  still  p^ts  to  enter  loop 
get  way  point  cooidinates 
exit  when  done 
endlot^ 

procedure  DO.SE  ARCH  is 
begin 

r^  in  the  tenain  data 
create  the  output  file 
loop 

exit  when  the  sectmd  node  in  WAVE  is  null 
while  WAVE  is  not  empty  and  the  goal  isn’t  found 
F_PArH 
end  loop; 
print  the  path 

reset  the  search  space  and  variables  to  initials  values 
end  loop 

close  the  output  file 
endDO_SEARCH 
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The  tendril  search  technique  is  used  in  each  path  planning  segment  A  *Vhile...loop” 
construct  was  added  to  the  DO.SEARCH  procedure  (in  the  PATHWP  package).  Each 
waypoint  is  processed  in  order,  rinding  a  path  between  each  of  two  successive  points.  The 
generated  path  segment  is  printed  to  a  rile  and  the  next  two  points  are  processed  until 
complete.  Upon  completion  of  a  path  segment  many  variables  need  to  be  reset  to  their 
initial  values  to  allow  the  next  path  segment  to  be  generated.  The  RESET_ALL  procedure 
resets  global  variables. 

This  path  planning  technique  divides  the  search  into  several  small  searches 
lending  itself  to  concurrent  processing.  While  one  processor  rinds  a  path  riom  the  start  to 
the  waypoint,  another  processor  could  rind  the  path  from  the  waypoint  to  the  goal.  This 
version  does  not  take  advantage  of  concurrent  processing,  it  rinds  each  path  segment 
sequentially.  Appendix  E  contains  the  Data  Dictionary,  DFD  and  program  code. 
Limitations 

As  previously  indicated,  memory  and  speed  have  continued  to  be  aconcem  in  this 
methods  efficiency  [Richbourg  et.  al.  87].  If  the  whole  search  space  needs  to  reside  in 
memory,  it  is  restricted  by  die  machines  c^bilities.  If  time  constraints  permit,  reading  and 
writing  to  a  rile  may  be  a  feasible  solution.  This  aspect  was  not  investigated  in  this  thesis. 
It  is  interesting  to  note  that  as  the  obstacle  density  increases,  a  larger  search  space  can  be 
stored  in  memory  without  causing  memory  problems.  This  is  a  result  of  *‘prurung”  the 
obstacle  nodes  from  the  legal  move  and  open  node  lists.  As  the  number  of  obstacle  nodes 
increases  the  free  space  is  logically  decreased. 

5.  The  Tendril  Algorithm 

The  Tendril  search  takes  as  input  the  starting  coordinates  including  orientaticm 
(row,  col,  dep,  hdg)  and  the  goal.  Terrain  data  is  read  frtnn  a  rile  and  is  implemented  in  a 
dynamic  array  described  by  the  first  few  items  (array  dimensions)  read  riom  the  rile.  From 
the  starting  point  and  consistent  with  the  iiutial  heading,  the  legal  moves  are  determined 
and  assigned  to  WAVE.  Each  node  in  WAVE  is  assigned  a  parent  node  (in  this  case  the 
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parent  is  the  starting  point)  and  its  tendril  length  is  calculated  from  the  tendril  length  of  the 
parent  plus  the  distance  from  the  parent  to  that  node.  Checks  are  made  to  ensure  nodes 
previously  processed  are  not  reprocessed  unless  the  resulting  tendril  length  is  shorter  than 
the  nodes  current  tendril  length.  This  process  is  performed  on  each  node  in  WAVE  which 
genoutes  another  wave.  Iteratively,  it  continues  until  a  wave  reaches  the  goal.  Once  the 
wave  containing  the  goal  is  fully  processed,  the  program  stops  the  search  and  backtracks 
from  the  goal,  via  its  parent  ‘'pointer'’  to  the  start,  printing  out  the  path  (or  writing  it  to  a 
nie).  Listed  below  is  the  pseudo-code  of  the  Tendril  search. 


procedure  TENDRIL  is 
begin 

GET_DArA; 

DO.SEARCH; 
end  TENDRIL; 

procedure  GET_DATA  is 

begin 

get  the  terrain  file  name 
get  array  data 

get  ST/^T  and  GOAL  coordinates 
endGET_DATA 

procedure  DO.SEARCH  is 

begin 

get  the  terrain  data 

while  the  WAVE  list  is  not  empty  loq) 
F_PATH 

exit  when  the  goal  is  found 
end  loop; 
print  the  path 
endDO.SEARCH 


As  previously  described  the  F.MOVES  procedure  performs  most  of  the  work.  It 
checks  for  the  ROOT’S  heading  and  uses  a  case  statement  to  handle  each  of  the  cardinal 
headings.  For  example,  when  the  vehicle  is  heading  north  (HDG  s  1)  only  the  nine  nodes 
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in  a  northerly  direction  are  evaluated.  These  evaluations  are  performed  in  the 
THE.MOVES  package.  Each  CHECK.  NODE  (where  NODE  represents  one  of  the  nine 
legal  moves)  procedure  determines  the  coordinates  of  the  legal  node  being  evaluated  and 
calls  the  CK.STATE  procedure.  In  CK.STATE  the  node’s  state  is  determined  to  be  either 
free  space  or  obstacle  space.  If  the  node  is  firee  space,  the  GROW.TEND  process  is  called. 
This  process  adjusts  the  tendril  length,  assigns  die  parent  (ROOT),  and  attaches  that  node 
to  the  NEW.WAVE  list  Other  procedures  are  used  to  process  the  WAVE  and 
NEW.WAVE  lists  in  support  of  the  F.MOVE  procedure. 

D.  TENDRIL  BIDIRECTTONAL  SEARCH 

1.  Concept 

Although  not  implemented  in  this  research  the  Tendril  Bidirectional  search  (TBS) 
appears  to  be  a  viable  solution  to  real-time  processing  problems.  This  method  lends  itself 
well  to  concurrent  processing  as  previously  described  for  the  Tendril  search  with 
waypoints.  With  the  installation  of  a  T-8(X)  transputer  board  into  die  NFS  AUV  H, 
concurrent  processing  is  highly  desirable  and  achievable. 

2.  Limitations 

An  important  consideradon  is  the  need  to  check  for  completion  after  each  wave 
iteration.  This  could  be  a  difficult  problem,  reducing  the  advantages  of  concurrency  by 
requiring  a  high  degree  of  communication  between  each  search  process. 

E.  EVALUATION  AND  RESULTS 

For  ease  of  comparison,  a  smaller  terrain  representation  was  used  in  the  evaluation  (S 
rows  X  5  columns  X  5  depths  X  4  headings).  When  tested  with  an  obstacle  firee  model,  the 
paths  generated  in  both  the  Ada  and  LISP  (compiled)  versions  were  identical.  The  Ada 
code  was  much  faster  (.24  seconds  vice  .933  seconds  for  LISP).  It  is  especially  significant 
considering  the  following  facts:  While  the  LISP  version  has  die  terrain  data  hard  coded,  the 
Ada  version  must  open  and  read  the  data  from  a  disk  file.  The  Ada  version  writes  its  results 
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to  the  screen  and  to  a  file.  Both  of  these  differences  are  I/O  processes  which  are  rimf 
intensive.  Even  with  these  VO  hindrances  the  Ada  version  was  the  fastest  In  an  obstacle 
intense  terrain  model,  results  were  similar. 
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IV.  VECTOR  FIELD  METHOD 


A.  GENERAL  DESCRIPTION 

Although  a  very  simple  process,  this  method  has  proven  to  be  the  most  efficient  of 
those  investigated  in  this  thesis.  Listed  below,  is  the  pseudo-code  for  the  DIRECTION 
procedure. 


procedure  DIRECTION  is 
begin 

GET.DATA 
DO_DIR 
end  DIRECTION 

procedure  GET_DATA  is 

begin 

get  the  terrain  file  name 
get  array  data 

get  START  and  GOAL  coordinates 
end  GET.DATA 

procedure  DO_DIR  is 

begin 

get  the  terrain  data 
FIND.MOVES 
FIND.PATH 
P_PATH 
end  DO_DIR 


The  legal  moves  are  determined  by  searching  backwards  from  the  goal.  The  node  attribute, 
NEXT,  stores  the  coordinates  of  a  successor  node  having  the  shortest  distance  to  traverse. 
As  legal  moves  are  determined  the  NEXT  attribute  is  assigned  the  cotmlinates  of  the  node 
being  expanded.  Therefore  the  nodes  generated  from  the  goal  will  have  the  goals 
coordinates  stored  in  the  NEXT  attribute.  Figure  4-1  illustrates  the  backwards  search 
process  and  direction  assignment  for  a  three  dimensional  problem  (row,  column,  and 
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heading)  with  the  GOAL  having  a  southerly  orientation.  The  numbers  in  each  node 
represent  the  order  that  they  were  processed  during  the  search.  Two  nodes  adjacent  to  the 
GOAL  remain  unassigned  because  it  is  impossible  for  these  nodes  to  move  directly  to  the 
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Figure  4>1  Representatim  of  a  Vector  Field 


GOAL  with  the  proper  orientation.  This  is  not  die  case  in  the  four  dimensional  problem 
(including  depth).  A  transition  in  depth  will  allow  all  paths  to  the  GOAL  to  be  generated. 

Nodes  are  processed  with  a  priority.  A  move  not  requiring  a  heading  change  is 
less  expensive  than  moves  that  do.  Nodes  are  put  into  a  search  queue  based  on  the  cost  to 
move  into  the  next  node.  The  entire  search  space  is  processed  this  way,  resulting  in 
“vectors”  being  assigned  to  every  free  space  node.  Once  the  starting  point  is  entered,  all 
moves  to  the  goal  are  immediately  available. 
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B.  ADVANTAGES  AND  DISADVANTAGES 


The  most  obvious  advantage  is  the  speed  at  which  this  process  runs  as  compared  to  the 
Tendril  search.  To  find  a  path,  the  user  provides  the  starting  point.  Each  individual  node 
“knows”  its  next  move  to  reach  the  goal.  Path  determination  is  just  a  matter  of  following 
the  NEXT  attributes  until  the  goal  is  reached.  No  calculations  are  required  during  the  path 
planning  process  making  it  very  fast. 

Other  searches  need  both  the  starting  point  and  the  goal  to  preprocess  the  search 
space.  The  Direction  process  needs  only  the  goal  to  prepare  the  search  space.  Since  the 
preprocessing  is  not  dependent  on  the  starting  point,  many  trials  with  various  starting  points 
can  be  investigated  with  only  the  cost  of  the  preprocessing  once. 

Another  advantage  is  the  ease  at  which  obstacles  are  handled  during  the  process. 
Originally  written  for  only  non-obstacle  terrain,  a  small  modification  was  required  to 
handle  obstacles  (i.e.  an  obstacle  is  an  illegal  NEXT  move). 

As  can  be  seen  in  Figure  4-1,  all  the  paths  to  the  GOAL  may  not  be  generated.  If  the 
starting  point  is  the  node  Just  to  the  right  of  the  GOAL,  a  path  may  not  be  found  (where  one 
exists)  to  reach  the  GOAL  with  the  appropriate  orientation  (southerly  heading).  This 
disadvantage  can  be  overcome  when  considering  a  four  dimensional  problem. 

C.  BASIC  PROGRAM  FLOW 

Similar  to  the  Tendril  search,  terrain,  starting  point  and  goal  information  are  taken  as 
input.  Some  of  the  procedures  are  exactly  the  same  as  those  used  in  the  Tendril  search, 
while  others  required  minor  modifications.  Most  notably  is  that  FIND_MOVES  procedure 
processes  legal  moves  in  “reverse”  from  the  F_MOVES  procedure  in  the  Tendril  search.  A 
pseudo-code  version  of  this  procedure  is  listed  below.  It  finds  all  the  legal  moves  from 
which  the  goal  can  be  reached  as  opposed  to  which  node  can  be  move  into  from  the  starting 
point.  The  legal  moves  are  placed  into  a  queue  of  active  nodes,  ACTIVE,  based  upon  a 
predefined  order  relative  to  heading.  The  ordering  results  in  the  nodes  with  the  least  cost 
being  at  the  head  of  the  queue  and  the  rest  follow  in  increasing  cost  order.  Each  member  of 


the  ACTIVE  queue  is  processed  in  a  similar  manner  with  its  legal  moves  being  appended 
to  the  end  of  the  queue.  As  each  node  is  processed  its  NEXT  attribute  is  assigned  the 
coordinates  of  its  parent.  This  is,  essentially,  a  pointer  to  the  shortest  move  to  attain  the 


procedure  FIND_MOVES  (N_ARRA Y  ;  in  out  NODE.ARRAY)  is 

heading  :  INT_TYPE  :=  ACnVE.LOC(4); 
list  :  LOC.ARRA Y  :=  ACTIVE.LOC; 
newjist :  LOC_ARRAY  :=  ACTIVE.LOC; 

begin 

while  the  ACTIVE  list  is  not  empty  loop 
heading  :=  ACTIVE.LOC(4); 
list  :=  ACTrVE.LC)C; 
new_list  :=  ACTIVE.LOC; 
case  heading  is 
when  heading  north  => 
check  the  southern  node 
check  the  upper  south  node 
check  the  lower  south  node 
check  the  southeast  node 
check  the  upper  southeast  node 
check  the  lower  southeast  node 
check  the  southwest  node 
check  the  upper  southwest  node 
check  the  lower  southwest  node 
when  heading  east  => ... 
when  heading  south  =>  ... 
when  heading  west  =>  ... 
when  others  => 
null 

end  case; 

endHND.MOVES; 


goal.  Processing  the  entire  search  space  results  in  every  free  space  node  being  assigned  a 
NEXT  node  to  move  to  and  a  cost  associated  with  that  move.  Obstacles  are  not  processed 
and  a  NEXT  move  cannot  be  assigned  the  coordinates  of  an  obstacle.  The  A_AND_A 
(analyze  and  assign)  procedure  insures  the  assignment  of  the  NEXT  attribute  is  done 
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properly.  The  P_PATH  process  generates  the  path.  Beginning  with  the  starting  node,  it 
follows  the  NEXT  “pointers”  until  the  goal  is  reached  and  writes  the  nodes  to  a  file. 
Appendix  E  contains  the  Data  Dictionaiy,  DFD,  and  program  code. 

D.  THE  DIRECTION  SEARCH  ALGORITHM 

Producing  most  of  the  work  for  this  technique  is  the,  previously  mentioned, 
FIND_MOVES  procedure.  Having  passed  in  N_ARRAY  (the  array  of  nodes)  it  uses  the 
GOAL  and  a  case  statement  to  determine  legal  moves.  It  is  very  similar  to  the  F_MOVES 
procedure  in  the  Tendril  search  except  that  it  works  in  “reverse.”  Looking  at  the  orientation 
required  in  the  GOAL,  it  determines  what  node  an  AUV  can  transition  from  to  attain  that 
GOAL.  Procedures  in  the  THE.MOVES  package  then  determine  the  coordinates  of  these 
nodes  and  calls  the  A_AND_A  procedure  (analyze  and  assign).  In  this  procedure  it  is 
determined  if  the  nodes  are  free  or  obstacle  space.  If  a  node  is  fiee  space  it  is  assigned  a 
value,  DIST,  equal  to  the  distance  that  must  be  traversed  to  enter  that  node.  It  is  also 
assigned  to  the  ACTIVE  queue  in  a  specified  order  as  previous  detailed.  Other  procedures, 
similar  to  the  Tendril  search,  are  supporting  means  for  processing  the  ACTIVE  list 

E.  RESULTS  AND  EVALUATION 

Similar  to  the  timing  results  of  the  Ada  version  of  the  Tendril  search,  the  Direction 
search  is  significantly  faster  then  the  LISP  Tendril  search.  The  results  of  a  search  conducted 
in  an  obstacle  free  space  produced  similar  results,  although  slightly  faster  (.2271  seconds 
vice  .233  for  Ada  Tendril).  This  timing  variance  may  be  explained  by  VO  differences.  A 
significant  timing  difference  was  noted  between  the  searches  in  an  obstacle  intense 
environment.  The  Direction  search  was  much  faster  (.11  seconds  vice  .329  seconds).  This 
is  attributed  to  the  different  way  obstacles  are  handled  in  the  two  programs.  The  Direction 
search  has  much  less  oveiliead  for  handling  obstacles. 
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V.  PATH  REPLANNING 


A.  GENERAL  DESCRIPTION 

A  path  replanner  is  a  path  planner  with  more  stringent  time  constraints.  It  is  needed 
when  an  AUV  is  required  to  circumnavigate  an  unexpected  obstacle  to  continue  its  mission. 
This  replanno'  must,  therefore,  operate  in  real-time  to  facilitate  an  efficient  transition  to  an 
alt^ate  path. 

The  Real-time  A*  (RTA*)  algorithm  presented  by  Kcnrf  [Korf  88]  was  modified  to 
incorporatB  four  dimensions.  This  method  can  use  any  of  the  previously  mentioned 
techniques  for  searching  (Best-first,  Tendril,  etc.)  but  only  searches  to  a  specified  search 
depth.  Nodes  at  the  search  depth  are  called  frontier  nodes.The  method  implemented  in  this 
thesis  uses  the  Tendril  search  to  a  search  depth  of  three  nodes.  As  die  search  progresses,  the 
cost  of  teaching  the  frontier  nodes  is  calculated.  Adding  this  cost  to  an  estimate  to  reach  the 
goal,  the  frontier  node  widi  the  lowest  overall  cost  is  chosen  to  be  expanded  upon.  The 
process  is  repeated  at  this  intermediate  fircmtier  node  and  successively  until  the  goal  is 
reached.  Appendix  F  contains  the  Data  Dicdtmary,  DFD  and  program  code.  Pseudo-code 
for  the  RTA*  search  is  listed  below. 


procedure  RTA  is 
begin 

GET.DATA 
DO.SEARCH 
end  RTA 

procedure  DO.SEARCH  is 
begin 

get  the  terrain  data  from  file 
while  the  goal  is  not  found  loop 
find  the  frontier  nodes 
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pick  the  node  with  the  estimated  least  cost 
end  loop 
print  the  path 
endDO_SEARCH 

B.  JUSTIFICATION 

Previously  presented  search  methods  may  not  be  efficient  enough  for  real-time  path 
replanning.  As  a  possible  solution  to  this  problem,  the  RTA*  technique  was  investigated. 
Due  to  the  nature  of  the  AUV’s  working  environment  it  is  feasible  to  “expect  the 
unexpected."  The  dynamic  nature  of  the  undersea  environment  can  alter  teirain  and 
obstacles  swiftly,  rendering  preprogrammed  paths  obsolete.  For  this  reason  an  on-board 
replanner  is  required  which  must  operate  in  real-time. 

Many  considerations  went  into  the  implementation  of  the  RTA*  ftn*  this  thesis: 


1.  What  search  method  should  be  used  to  find  the  frontier  nodes? 

2.  What  should  the  search  depth  be? 

3.  Would  the  old  path  be  completely  disregarded  or  should  a  new  path  try  to  return  to  the 
old  path  as  soon  as  possible? 

4.  Should  this  procedure  handle  the  initial  collision  avoidance  maneuver? 

5.  How  “real”  is  real-time? 


These  questions  had  to  be  properly  answered  to  produce  a  true  real-time  path 
replanner.  Since  this  thesis  predominately  examined  the  Tendril  search,  it  was  determined 
that  it  should  be  used  for  the  search  method  in  the  RTA*.  The  search  depth  was  arbitrarily 
chosen  at  five  nodes  and  later  reduced  to  three  because  of  memory  limitations.  Old  path 
data  is  discarded  and  the  new  path  does  not  attempt  to  “get  back  on"  the  old  path.  Initial 
collision  avoidance  is  to  be  performed  by  a  different  procedure  and  this  RTA*  would  be  a 
path  replaimer  only.  Strict  real-time  constraints  have  not  been  set. 
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C.  DISADVANTAGES 

Although  good  for  two  dimensional  problems,  the  RTA*  is  very  memory  intensive  for 
multi-dimensional  problems.  As  waves  are  processed  the  legal  moves  for  all  nodes  up  to 
the  search  dqrtii  must  be  retained.  To  illustrate  the  exponential  growth  of  search  nodes, 
consider  a  starting  point  that  has  only  three  legal  moves  in  its  first  frontier.  At  a  two  node 
frontier  distance  (or  second  frontier)  27  legal  moves  must  be  maintained  and  243  legal 
moves  at  a  tiiree  frontier.  A  combinatorial  explosion  results  with  further  processing.  For  a 
moving  vehicle,  a  tiiree  node  length  look  ahead  capability  may  be  insufficient  (depending 
on  node  size)  for  obstacle  avoidance  reaction  time. 

D.  EVALUATION 

Due  to  the  massive  memory  requirements,  this  process  appeared  to  be  fruitless 
especially  when  the  good  results  of  the  previously  presented  methods  are  considered.  Uptm 
a  second  ccmsideration,  it  is  feasible  to  incorporate  pruning  methods  to  help  eliminate 
unnecessary  processing  of  nodes  which  should  not  be  processed.  Pruning  techniques  were 
successfully  used  in  the  other  methods  and  thetefcne  should  not  be  difficult  to  implement 
into  the  RTA*  search.  Further  research  with  this  method  is  recmnmended. 
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VI.  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  SUMMARY  AND  CONCLUSIONS 

This  thesis  investigated  several  path  planning  techniques  using  a  nodal  representation 
of  the  search  space.  A  four  dimensional  Tendril  search  was  implemented  in  Ada  and  a  time 
comparison  to  a  LISP  version  was  made.  The  results  indicate  that  it  is  feasible  to  use  Ada 
for  intelligent,  real-time  path  planning.  One  version  of  the  Tendril  search  incorporated  a 
waypoint  capability.  It  is  an  important  aspect  that  should  be  looked  at  more  carefully  for 
implementation  in  the  NPS  AUV II. 

The  Direction  search,  using  a  vector  field  was  implemented.  This  method  proved  to  be 
the  fastest  of  the  methods  investigated.  Due  to  its  speed  and  simplicity,  it  is  highly 
recommended  for  the  NPS  AUV  II  replanner  for  the  near  term. 

The  RTA*  search  initially  appeared  to  be  cumbersome  for  multi-dimensional  path 
replanning.  Upon  reconsideration,  it  could  be  modified  to  take  advantage  of  pruning 
techniques  to  eliminate  unnecessary  node  processing. 

B.  RECOMMENDATIONS 

Each  method  of  path  planning  investigated  was  valuable  for  various  reasons. 
Simplicity  was  the  prevailing  aspect  in  all  methods  which,  in  turn,  resulted  in  small  time 
requirements  for  search  space  processing.  Of  these  procedures  the  Direction  search  was  the 
simplest  and  fastest,  thus  recommended  for  further  research  to  incoiporate  into  the  NPS 
AUV  n  as  the  onboard  path  replanner. 

It  should  be  noted  that  there  are  limited  orientation  capabilities  for  each  method. 
Although  only  the  cardinal  headings  were  used,  the  results  are  sufficient  for  path-planning 
purposes.  The  guidance  module  of  the  NPS  AUV  II  does  not  use  the  orientations  produced 
in  the  path  planning  process.  It  uses  only  three  dimensional  coordinates,  generating 
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orientation  more  accurately  itself.  Thus,  the  course  orientations  of  these  path  planners  are 
only  for  their  internal  use  to  accommodate  more  accurate  planning.  [Magrino  91] 

The  use  of  waypoints  is  a  very  important  feature  of  path  planning,  whether  for  an 
aircraft,  AUV,  or  a  trip  to  the  comer  market.  Use  of  the  Direction  search  with  a  waypoint 
capability  is  recommended  for  further  research.  It  may  be  difficult  or  time  restrictive  since 
the  vector  Held  generated  depends  on  the  goal.  A  new  vector  field  is  required  for  each  path 
segment.  Consideration  should  be  given  to  dividing  the  search  space  into  portions,  each 
path  segment  having  its  own  portion  of  the  search  space  eliminating  the  requirement  to 
reinitialize  the  entire  search  space  after  each  path  segment  is  planned. 

The  Tendril  Bidirectional  Search  (TBS)  lends  itself  to  concurrent  processing.  The  use 
of  transputers  could  make  this  an  exceptional  method  for  real-time  path  planning. 

Consideration  should  be  given  to  the  use  of  multiple  path  planning  and  replanning 
methods.  Planning  for  obstacle  intense  environments  is  significantly  different  from 
obstacle  sparse  environments.  In  most  cases  it  appeared  that  the  easiest  path  to  plan  (no 
obstacles)  took  the  longest  time.  The  Mission  Planning  Expert  System  has  the  capability  to 
determine  appropr  ate  planning  methods  yet  it  has  very  few  methods  inqilemenmd.  Further 
research  is  required  to  build  upon  the  MPES  path  planning  methods. 
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APPENDK  B  - 

NPS  AUV  n  System  Block  Diagram 


APPENDK  C 

Three  Dimensional  Tendril  Search  in  LISP 

defstnict  node  state  parent  tendril-length  link-list) 

(defvar  *new-active-node-list*  nil) 

(defvar  *active-node-list*  nil) 

(defvar  ♦goal*  nil) 

(defvar  *goal-flag*  nil) 

(defvar  *node-airay*  (make-array  ‘(6  7  7  7))) 

(defvar  *cycle-number*  0) 

(defvar  ♦terrain*  (make-array  ‘(6  7  7  7)  nnitial-contents  (ommitted) 

(defun  create-node  (h  k  i  j) 

(setf  (aref  *node-aiTay*  h  k  i  j)  (make-node))) 

(defun  initialize-state  (h  k  i  j) 

(if  (=  1  (aref  *terrain*  h  k  i  j)) 

(setf  (node-state  (aref  *node-array*  h  k  i  j))  ‘obstacle))) 

(defiin  set-state  (heading  depth  row  column  state) 

(setf  (node-state  (aref  *node-array*  heading  depth  row  column))  state)) 

(defim  set-parent  (heading  depth  row  column  parent) 

(setf  (node-parent  (aref  *node-array*  heading  depth  row  column))  parent)) 

(defim  set-tendril-length  (heading  depth  row  column  length) 

(setf  (node-tendril-length  (aref  *node-arTay*  heading  depth  row  column))  length)) 

(defim  set-link-list  (heading  depth  row  column  list) 

(setf  (node-link-list  (aref  *node-array*  heading  depth  row  column))  list)) 

(defim  state  (heading  depth  row  column) 

(node-state  (aref  *node-array*  heading  depth  row  column))) 

(defim  parent  (heading  depth  row  column) 

(node-parent  (aref  *node-array*  heading  depth  row  column))) 

(defim  tendril-length  (heading  depth  row  column) 

(node-tendril-length  (aref  *node-array*  heading  depth  row  column))) 

(defim  link-list  (heading  depth  tow  column) 

(node-link-list  (aref  *node-array*  heading  depth  row  column))) 
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(defiin  make-tenain  (heading-size  depth-size  row-size  column-size) 

(dotimes  (h  heading-size  ‘tenain-initialized) 

(dotimes  (k  depth-size) 

(dotimes  (i  row-size) 

(dotimes  (j  column-size) 

(create-node  h  k  i  j) 

(initialize-state  h  k  i  j)))))) 

(defim  legal-fwd-connected-link-list  (heading  depth  row  column) 

(non-nil-ctms  (4-link  heading  depth  (1-  row)  column) 

(non-nil-cons  (diag-link-ul  2  depth  (1-  row)  (1-  column)) 

(ncm-nil-cons  (diag-link-ur  4  depth  (1-  row)  (1+  column)) 

(non-nil-cons  (diag-up-link-ul  2  (1-  depth)  (1-  row)  (1-  column)) 

(non-nil-cons  (diag-up-link-u  heading  (1-  depth)  (1-  row)  column) 

(non-nil-cons  (diag-up-link-ur  4  (1-  depth)  (1-  row)  (1+  column)) 

(non-nil-cons  (diag-down-link-ul  2  (1+  depth)  (1-  row)  (1-  column)) 
(non-nil-cons  (diag-down-link-1  heading  (1+  depth)  (1-  row)  column) 
(non-nil-cons  (diag-down-link-ur  4  (1+  depth)  (1-  row)  (1+  column))  nil)))))))))) 

(defim  legal-left-connected-link-list  (heading  dq>th  row  column) 

(non-nil-cons  (4-link  heading  depth  row  (1-  column)) 

(non-nil-cons  (diag-link-ul  1  depth  (1-  row)  (1-  column)) 

(non-nil-cons  (diag-link-11 3  depth  (1+  row)  (1-  column)) 

(non-nil-cons  (diag-up-Iink-ul  1  (1-  depth)  (1-  row)  (1-  column)) 

(non-nil-cons  (diag-up-link-1  heading  (1-  depth)  row  (1-  column)) 

(ncm-nil-cons  (diag-up-link-U  3  (1-  depth)  (1+  row)  (1-  column)) 

(non-nil-cons  (diag-down-link-ul  1  (l-»-  depth)  (1-  row)  (1-  column)) 
(ncm-nil-cons  (diag-down-link-l  heading  (1+  depth)  row  (1-  column)) 
(ncm-nil-cons  (diag-down-link-U  3  (1+  depth)  (1+  row)  (1-  column))  nil)))))))))) 

(defun  legal-back-ccmnected-link-list  (heading  depth  row  column) 

(non-nil-cons  (4-link  heading  depth  (1-t-  row)  column) 

(non-nil-cons  (diag-link-U  2  depth  (1+  row)  (1-  column)) 

(non-nil-cons  (diag-Unk-lr  4  depth  (1+  row)  (1-t-  column)) 

(non-nil-cons  (diag-up-link-11 2  (1-  depth)  (1-i-row)  (1-  column)) 

(non-nil-cons  (diag-up-link-d  heading  (1-  depth)  (l-i-  row)  column) 

(non-nil-cons  (diag-up-link-lr  4  (1-  depth)  (1-t-  row)  (1-t-  column)) 

(non-nil-cons  (diag-down-link-11 2  (l-t-  depth)  (1-t-  row)  (1-  column)) 
(non-nil-cons  (diag-down-link-d  heading  (1+  depth)  (1-t-  row)  column) 
(non-nil-cons  (diag-down-link-lr  4  (1-t-  depth)  (l-i-  row)  (l-i-  column))  nil)))))))))) 

(defun  legal-right-connected-link-list  (heading  depth  row  column) 

(non-nil-cons  (4-link  heading  depth  row  (1-t-  column)) 
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(non-nil-oms  (diag-link-lr  3  depth  (1+  row)  (1+  column)) 

(non-nil-cons  (diag-link-ur  1  depth  (1-  row)  (1+  column)) 

(non-nil-cons  (diag-up-link-lr  3  (1-  depth)  (1-t-  row)  (1+  column)) 

(non-nil-cons  (diag-up-link-r  heading  (1-  depth)  row  (1+  column)) 

(non-nil-cons  (diag-up-link-ur  1  (1-  depth)  (1-  row)  (1+  column)) 

(non-nil-cons  (diag-down-link-lr  3  (1+  depth)  (1+  row)  (1+  column)) 
(non-nil-cons  (diag-down-link-r  heading  (1+  depth)  row  (1+  column)) 
(non-nil-cons  (diag-down-link-ur  1  (1+  depth)  (1-  row)  (1+  column))  nil)))))))))) 

(defun  4-link  (heading  depth  row  column) 

(if  (not  (equal  (state  hea^g  depth  row  column)  ‘obstacle)) 

(list  (list  heading  depth  row  column)  2))) 

(defun  diag-link-ul  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  depth  row  (1-t-  column))  ‘obstacle)) 

(not  (equal  (state  heading  depth  (1-t-  row)  colunm)  ‘obstacle)))) 

(list  (list  heading  depth  row  column)  (*  2  (sept  2))))) 

(defun  diag-link-U  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  depdi  (1-  row)  column)  ‘obstacle)) 

(not  (equal  (state  heading  depth  row  (1-f  column))  ‘obstacle)))) 

(list  Gist  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defun  diag-link-lr  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  depdi  (1-  row)  column)  ‘obstacle)) 

(not  (equal  (state  heading  depth  row  (1-  column))  ‘obstacle)))) 

(list  (list  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defim  diag-link-ur  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  depth  row  (1-  column))  ‘obstacle)) 

(not  (equal  (state  heading  depth  (1-t-  row)  column)  ‘obstacle)))) 

Gist  Gist  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defim  diag-up-link-ul  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (l-i-  depth)  row  column)  ‘obstacle)) 

(not  (equal  (state  heading  depth  (1-f  row)  (1-f  column))  ‘obstacle)))) 

Gist  Gist  heading  depth  row  column)  (*  2  (sqrt  2))))) 
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(defun  diag-up-link-I  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
(or  (not  (equal  (state  heading  (1+  depth)  row  column)  *d>stacle)) 
(not  (equal  (state  heading  depth  row  (1+  column))  ‘obstacle)))) 

(list  (list  heading  tiepth  row  column)  (♦  2  (sqrt  2))))) 

(defiu  diag-up-link-11  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
(or  (not  (equal  (state  heading  (1+  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1-  row)  (1+  column))  ‘obstacle)))) 
(list  Gist  heading  depth  row  column)  (*  2  (sqit  2))))) 

(defiin  diag-up-link>d  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
(or  (not  (equal  (state  heading  (1+  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1-  row)  colunrn)  ‘obstacle)))) 

(list  (list  heading  depth  row  column)  (*  2  (sqit  2))))) 

(defim  diag-up-link-lr  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (1+  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1-  row)  (1-  column))  ‘obstacle)))) 
(list  (list  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defim  diag-up-link-r  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (1+  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  row  (1-  column))  ‘obstacle)))) 

(list  (list  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defim  diag*up-link-ur  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  colunrn)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (1+  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1+  row)  (1-  column))  ‘obstacle)))) 
(list  (list  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defun  diag~up-link*u  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  colunrn)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (1+  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1+  row)  column)  ‘obstacle)))) 

(list  Gist  heading  depth  row  column)  (*  2  (sqit  2))))) 


(defim  diag*down-link-ul  (heading  depth  row  column) 
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(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1+  row)  (1+  column))  ‘obstacle)))) 
(list  (list  heading  depth  row  column)  (♦  2  (sqrt  2))))) 


(defiin  diag-down-link-1  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  row  (1+  column))  ‘obstacle)))) 

Gist  (list  heading  depth  row  column)  (*  2  (sqit  2))))) 

(defiin  diag-down-link-U  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 
(not  (^ual  (state  heading  depth  (1-  row)  (1+  column))  ‘obstacle)))) 
(list  (list  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defun  diag-down-link-d  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1-  row)  column)  ‘obstacle)))) 

(list  (list  heading  depth  row  column)  (♦  2  (sqrt  2))))) 

(defim  diag-down-link-lr  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 

(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1-  row)  (1-  column))  ‘obstacle)))) 
(list  (list  heading  depth  row  column)  (*  2  (sqrt  2))))) 


(defim  diag-down-link-r  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  row  (1-  column))  ‘obstacle)))) 

(list  Gist  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(defim  diag-down-link-ur  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 
(not  (equal  (state  heading  depth  (1+  row)  (1-  column))  ‘obstacle)))) 
(list  Gist  heading  depth  row  column)  (♦  2  (sqrt  2))))) 

(defim  diag-down-link-u  (heading  depth  row  column) 

(if  (and  (not  (equal  (state  heading  depth  row  column)  ‘obstacle)) 
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(or  (not  (equal  (state  heading  (1-  depth)  row  column)  ‘obstacle)) 

(not  (equal  (state  heading  depth  (1+  row)  column)  ‘obstacle)))) 

(list  Gist  heading  depth  row  column)  (*  2  (sqrt  2))))) 

(deGin  non-nil-cons  (item  list) 

(if  (null  item)  list  (cons  item  list))) 

(defim  initialize-heading-connected-map  (heading-size  depth-size  row-size  column-size) 
(make-terrain  heading-size  depth-size  row-size  column-size) 

(dotimes  (h  (-  heading-size  2)) 

(dotimes  (k  (-  heading-size  2)) 

(dotimes  (i  (-  row-size  2)) 

(dotimes  (j  (-  column-size  2)) 

(set-tendril-length  (1+  h)  (1+  k)  (1+  i)  (1+ j)  0) 

(if(=(l+h)l) 

(set-link-list  (1+  h)  (1+  k)  (1+  i)  (1+ j) 

Gegal-fwd-connected-link-list  (1+  h)  (1+  k)  (1+  i)  (1+ j)))) 

(if(=(l+h)2) 

(set-link-list  (1+  h)  (1+  k)  (1+  i)  (1+  j) 

Gegal-left-connected-link-list  (1+  h)  (1+  k)  (1+  i)  (1+ j)))) 

(if(=(l+h)3) 

(set-link-Ust  (1+  h)  (1+  k)  (1+  i)  (1+ j) 

Gegal-back-connect^-link-list  (1+  h)  (1+  k)  (1+  i)  (1+ j)))) 

(if(=(l+h)4) 

(set-link-list  (1+  h)  (1+  k)  (1+  i)  (1+ j) 

Gegal-right-connected-link-list  (1+  h)  (1+  k)  (1+  i)  (1+ j))))))))) 

(defim  update-root-node  (heading  depth  row  column  new-tendril-length  new-link-list) 
(set-tendril-length  heading  depth  row  column  new-tendril-length) 

(set-link-list  heading  depth  row  column  new-link-list)) 

(defim  activate-end-node  (root  node  residue) 

(if  (equal  node  *goal*)  (setf  ♦goal-flag*  t)) 

(set-state  (first  node)  (second  node)  (third  node)  (fourth  node)  ♦cycle-number*) 
(set-parent  (first  node)  (second  node)  (third  node)  (fourth  node)  root) 

(set-tendril-length  (first  node)  (second  node)  (third  node)  (fourth  node)  residue) 

(setf  *new-active-node-list*  (cons  node  *new-active-node-list*))) 

(defim  verify-parent  (root  node  residue) 

(when  (>  residue  (tendril-length  (first  node)  (second  node)  (third  node)  (fourth  node))) 
(set-parent  (first  node)  (second  node)  (third  node)  (fourth  node)  root) 

(set-tendril-length  (first  node)  (second  node)  (third  node)  (fourth  node)  residue))) 
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(defiin  test-link  (root  link  tendril-length) 

Get  ((residue  (-  tendril-length  (second  link))) 

(end-node-state  (state  (first  (first  link))  (second  (first  link))  (third  (first  link))  (fourth  (first 
link))))) 

(cond  ((and  (null  end-node-state)  (>=  residue  0)) 

(activate-end-node  root  (first  link)  residue)  nil) 

((and  (numberp  end-node-state)  (=  "‘cycle-number*  end-node-state) 

(>=  residue  0)) 

(verify-parent  root  (first  link)  residue)  nil) 

((null  end-node-state)  link)))) 

(defiin  grow-tendrils  (root  tendril-increment) 

Get*  ((heading  (first  root))  (depth  (second  root))  (row  (third  root))  (column  (fourdi  root)) 
(new-tendril-length  (+  tendril-increment  (tendril-length  heading  depth  row  column))) 
(new-link-list  nil)) 

(dolist  Gink  (link-list  heading  depth  row  column) 

(update-root-node  heading  depth  row  column  new-tendril-length  new-link-list)) 

(setf  new-link-list  (non-nil-cons  (test-link  root  link  new-tendril-length) 
new-link-list))))) 

(defiin  increment-wavefront  (tendiil-inciement)  ;ietumed  value  not  used 
(dolist  (root  *active-node-list*  *new-active-node-list*) 

(setf  *new-active-node-list* 

(non-nil-cons  (test-root  root  tendril-increment)  *new-active-node-list*)))) 

(defiin  test-root  (root  tendril-increment)  ;retums  root  if  any  tendrils  alive 
(if  (grow-tendrils  root  tendril-increment)  root)) 

(defim  find-path  (start  goal  tendril-increment) 

(initialize-heading-connected-mi^  67  7  7) 

(set-state  (first  start)  (second  start)  (third  start)  (fourth  start)  0) 

(setf  *goal*  goal  *cycle-number*  0  *active-node-list*  (list  start) 

*goal-fiag*  nil) 

Goop  (if  (or  (null  *active-node-list*)  (not  (null  *goal-flag*))) 

(return  (if  (not  (null  *goal-flag*))  (pprint  (path-to-goal  goal))))) 

(setf  *new-active-node-list*  nil) 

(setf  *cycle-number*  (1+  *cycle-number*)) 

(setf  *active-node-list*  (increment-wavefront  tendril-increment)))) 

(defiin  path-to-goal  (goal) 

Get  ((parent  (parent  (first  goal)  (second  goal)  (third  goal)  (fourth  goal)))) 

(if  parent  (cons  goal  (path-to-goal  parent))))) 
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APPENDIX  D  (part  1) 


Table  1:  Data  Dictionary  for  the  Tendril  Search 


PACKAGE 

PROCEPURE 

VARIABLE 

TYPE 

GLOBALS 

DATA.FILE 

PATH_FILE 

FILE_TYPE 

LOC.ARRAY 

array  (1..4)  of  INT_TYPE 

LIST 

recoid  {LOC :  LOC_ARRAY 

INC :  INT_TYPE 

NEXT :  UST_PTR} 

NODE 

record  {STATE :  INT.TYPE 

PARENT :  LOC.ARRAY 
TEND_LEN ;  INT_TYPE) 

NODE_ARRAY 

array  (INTjrYffi  range  o, 

INT.TYPE  range  o, 

INT_TYPE  range  o, 

INT.TYPE  range  o)  of  NODE 

START_TIME 

END.UME 

TIME 

T_TIME 

DURATION 

MAX_ROW 

MAX.OOL 

MAX.DEP 

MAX_HDG 

DUG_OOST;=99 

CARD_OOST:=70 

INT_TYPE 
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Tible  1:  Data  Dictionary  for  the  Tendril  Search 


PACKAGE 

PROCEDURE 

VARIABLE 

TYPE 

WAVE 

NEW.WAVE 

NW.TAIL 

LAST_NEW_WAVE 

WAVE.HEAD 

WAVE.TAIL 

THE_PATH 

THE_PATH_CURRENT 

TRASH 

LIST_PTR:=nuU 

START 

GOAL 

LOC.ARRAY 

GOAL.FOUND 

BOOLEAN  :=  FALSE 

PATH 

GET  DATA 

FEJE_NAME 

STRING  (1..12) 

NAME_LEN 

INT.TYPE 

P  PATH 

NEXT_LOC 

LOC.ARRAY 

F  MOVES 

HEADING 

INT_TYPE  :=  ROOTXOC  (4) 

F  PATH 

ROOT 

LIST_PTR:=WAVE 

DO  SEARCH 

N.ARRAY 

NODE.ARRAY  (l..MAX_ROW, 
L.MAX_COL, 
l..MAX_DEP, 
L.MAX_HDG) 
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Table  1:  Data  Dictionary  for  the  Tendril  Search 


PACKAGE 

PROCEDURE 

VARIABLE 

TYPE 

THE  MOVE 

CK  STATE 

NEW_ELE 

LIST.PTR 

1  NEW_LOC 

LOC_ARRAY  :=  ROOTJjOC 
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DATA  FLOW  DIAGRAM  for  the  TENDRIL  SEARCH  (part  2) 


TENDRIL  SEARCH  CODE  (part  3) 


— NAME 

—DATE 

—REVISED 

— TITLE 

—DESCRIPTION 

—CALLS 

—NOTES 


J.  Bonsignore,  Jr. 

22  Jan,  1991 

TENDRIL. ADA 

Main  procedure  for  the  Tendril  search 
GET  DATA  and  DO_SEARCH  in  the  PATH  package 


with  TEXT_IO,  GLOBALS,  PATH; 
use  TEXT_IO,  GLOBALS,  PATH; 

procedure  TENDRIL  is 

begin 

GET_DATA; 

DO_SEARCH; 
end  TENDRIL; 


— NAME  :  J.  Bonsignore,  Jr. 

—DATE  :  22  Jan,  1991 

—REVISED  ; 

—TITLE  :  GLOBALS.ADS 

— DESCRIPTION  :  Global  variables  for  the  searches 

—CALLS  : 

—NOTES  : 


with  TEXT_IO,  CALENDAR; 
use  TEXT_IO,  CALENDAR; 

package  GLOBALS  is 

subtype  INT_TyPE  is  INTEGER; 
package  INT_IO  is  new  INTEGER_IO  (INT_TYPE) ; 
package  FLOATIO  is  new  FLOAT_IO  {FLOAT) ; 
use  INT_IO,  FLOATIO; 

type  LOC_ARRAy  is  array  (1..4)  of  INT_TYPE; 
type  LIST; 

type  LIST_PTR  is  access  LIST; 
type  LIST  is 
record 

LOC  :  LOC_ARRAY:=  (others  =>  0); 

INC  ;  INT_TYPE  :=  0; 

NEXT  :  LIST_PTR; 
end  record; 

type  NODE; 

type  NODE_PTR  is  access  NODE; 
type  NODE  is 
record 

STATE  :  INT_TYPE  :=  0; 

PARENT  ;  LOC_ARRAY  :=  (others  =>  0) ; 

TEND_LEN  ;  INT_TYPE  ;=  0; 
end  record; 

type  NODE_ARRAY  is  array  (INT_TYPE  range  <>,  INT_TYPE  range 

<>, INT_TYPE  range  <>,  INT_TYPE 
range  <>)  of  NODE; 
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DATA_FILE 

• 

• 

FILE_TYPE; 

PATH_FILE 

• 

• 

FILE_TYPE; 

START_TIME 

• 

• 

TIME; 

END_TIME 

• 

• 

TIME; 

T__TIME 

• 

• 

DURATION; 

MAX_ROW 

• 

• 

INT_TYPE; 

MAX_COL 

• 

• 

INT_TYPE; 

MAX_DEP 

• 

• 

INT_TYPE; 

MAX_HDG 

• 

• 

INT_TYPE; 

DIAG_COST 

• 

• 

INT^TYPE  := 

99 

t 

CARD_COST 

• 

• 

INT_TYPE  := 

70 

• 

9 

WAVE 

:  LIST_PTR 

t  = 

null; 

NEW_WAVE 

:  LIST_PTR 

:  = 

null; 

NW_TAIL 

:  LIST  PTR 

:  = 

null; 

LAST_NEW_WAVE  :  LIST_PTR 

•  = 

null; 

WAVE_HEAD 

:  LIST_PTR 

•  ss 

null 

WAVE_TAIL 

;  LIST  PTR 

•  = 

null 

THE_PATH 

;  LISt”ptR 

:  = 

null 

THE__PATH_CURRENT  :  LIST_PTR 

•  s: 

null 

TRASH  :  LIST_ 

_PTR  null; 

START 

LOC_ARRAY; 

GOAL 

• 

LOC__ARRAY; 

GOAL_FOUND 

• 

• 

BOOLEAN  :=  FALSE; 

end  GLOBALS; 
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—NAME 
—DATE 
—REVISED 
—TITLE 
— DESCRIPTION 


J.  Bonsignore,  Jr. 
22  Jan,  1991 

PATH. ADS 


—CALLS 

—NOTES 


with  TEXT_IO,  GLOBALS,  THE_MOVE, 
UNCHECKED_DEALLOCATION,  CALENDAR; 
use  TEXT_IO,  GLOBALS,  THE_MOVE,  CALENDAR; 

package  PATH  is 

procedure  DO_SEARCH; 

procedure  GET_DATA; 

procedure  READ_TER  (N_ARRAY  :  in  out  NODE_ARRAY) 
procedure  P_PATH  (N_ARRAy  :  in  out  NODE_ARRAY) ; 
end  PATH; 


—NAME 

—DATE 

—REVISED 

—TITLE 

—DESCRIPTION 


J.  Bonsignore,  Jr. 
22  Jan,  1991 

PATH.ADB 


—CALLS 

—NOTES 


package  body  PATH  is 

procedure  GET_DATA  is 

FILE  NAME  ;  STRING  (1..12); 
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NAME_LEN  :  INT_TYPE; 
begin 

put  ("Enter  the  name  of  data  file:  "); 
get_line  (FILE_NAME,  NAME_LEN) ; 

FILE_NAME  ( (NAME_LEN  +  1)..12)  :=  (others  =>  '  ’); 
FILE_NAME  (9.. 12)  :=  ".DAT"; 

OPEN  (DATA_FILE,  MODE  =>  IN_FILE,  NAME  =>  FILE_NAME) ; 
INT_IO.get  (DATA_FILE,  MAX_ROW) ; 

INT_IO.get  (DATA_FILE,  MAX_COL) ; 

INT_IO.get  (DATA_FILE,  MAX_DEP) ; 

INT_I 0 . get  ( DATA_F I LE ,  MAX_HDG ) ; 

NEW_LINE; 

put  ("Enter  the  starting  row:  "); 

INT_IO.get  (START (1)); 

NEW_LINE; 

put  ("Enter  the  starting  col:  "); 

INT_IO . get  ( START ( 2 ) ) ; 

NEW_LINE; 

put  ("Enter  the  starting  dep:  ") ; 

INT_IO.get  (START (3)); 

NEW_LINE; 

put  ("Enter  the  starting  hdg:  ") ; 

INT_IO . get  (START (4 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  row:  "); 

INT_IO . get  (GOAL ( 1 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  col:  ") ; 

INT_IO . get  (GOAL (2 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  dep:  "); 

INT_IO . get  (GOAL ( 3 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  hdg:  "); 

INT_IO.get  (GOAL (4)); 

WAVE  :=  new  LIST; 

WAVE. LOG  :=  START; 

WAVE. INC  :=  0; 
end  GET_DATA; 

procedure  READ_TER  (N_ARRAY  :  in  out  NODE  ARRAY)  is 
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begin 

for  ROW  in  l..MAX_ROW  loop 
for  COL  in  l..MAX_COL  loop 

for  DEP  in  l..MAX_DEP  loop 
for  HDG  in  l..MAX_HDG  loop 
INT_IO.get  (DATA_FILE,  N_ARRAY (ROW,  COL, 
DEP,  HDG) .STATE) ; 

N_ARRAy(ROW,  COL,  DEP,  HDG) . TEND_LEN  :=  0; 
N_ARRAY(ROW,  COL,  DEP,  HDG) .PARENT  := 

(0, 0,0,0); 

end  loop; 
end  loop; 
end  loop; 
end  loop; 

close  (DATA_FILE) ; 
end  READ_TER; 

procedure  P_PATH  (N_ARRAY  :  in  out  NODE_ARRAY)  is 

NEXT_LOC  :  LOC_ARRAY; 

PATH_FILE  ;  FILE_TYPE; 

begin 

if  GOAL_FOUND  then 

CREATE  (PATH_FILE,  NAME  =>  "path. file") ; 
put  ('('); 

INT_IO.put  (GOAL(l)); 

INT_IO.put  (GOAL (2)); 

INT_IO.put  (GOAL (3)); 

INT_IO.put  (GOAL(4)); 
put  O'); 

INT_IO . put  (PATH_FILE,  GOAL ( 1 ) ) ; 

INT_IO.put  (PATH_FILE,  GOAL(2)); 

INT_IO . put  (PATH_FILE,  GOAL ( 3 ) ) ; 

INT_IO.put  (PATH_FILE,  GOAL (4)); 
new_line; 

new_line  (PATH_FILE) ; 

NEXT_LOC  :=  N_ARRAY(GOAL(l) ,  GOAL (2),  GOAL (3), 

GOAL (4) ) .PARENT; 
while  NEXT_LOC  /=  START  loop 
put  ( ' ( ' ) ; 

INT_IO . put  (NEXT_LOC ( 1 ) ) ; 

INT  10. put  (NEXT  LOC(2)); 
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INT_IO . put  (NEXT_LOC ( 3 ) ) ; 

INT_IO . put  (NEXT_LOC ( 4 ) ) ; 
put  ( ' )  ' ) ; 

INT_IO.pUt  (PATH_FILE,  NEXT_LOC ( 1 ) ) ; 
INT_IO.put  (PATH_FILE,  NEXT_LOC ( 2 ) ) ; 

INT_IO . put  (PATH_FILE ,  NEXT_LOC ( 3 ) ) ; 

INT_IO . put  (PATH_FILE ,  NEXT_LOC (4 ) ) ; 

NEXT_LOC  : =  N_ARRAY (NEXT_LOC ( 1 )  ,  NEXT_LOC {2) , 
NEXT_LOC (3) ,NEXT_LOC (4) ) .PARENT; 

NEW_LINE; 

new_line  (PATH_FILE) ; 
end  loop; 
put  (*(’); 

INT_IO.pUt  (START  (D); 

INT_IO.put  (START (2) ) ; 

INT_IO.put  (START (3) ) ; 

INT_IO.put  (START (4) ) ; 
put  O'); 

INT_IO . put  (PATH_FILE,  START ( 1 ) ) ; 

INT_IO.put  (PATH_FILE,  START (2)); 

INT_IO . put  (PATH_FILE,  START ( 3 ) ) ; 

INT_IO.pUt  (PATH_FILE,  START (4)); 
new_line; 

new_line  (PATH_FILE) ; 

INT_IO.put  (N^ARRAY  (GOAL(l),  GOAL (2),  GOAL (3), 

GOAL (4) ) .TEND_LEN) ; 

new_line; 

CLOSE  (PATH_FILE); 
else 

put  ("PATH  NOT  FOUND"); 
new_line; 
end  if; 
end  P_PATH; 

procedure  F_MOVES  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

HEADING  ;  INT_TYPE  :=  ROOT.LOC(4); 

begin 

case  HEADING  is 
when  1  => 

CHECK  UP  NW  (N  ARRAY,  ROOT) ; 
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CHECK_UP_N  (N_ARRAY,  ROOT) ; 
CHECK_UP_NE  (N_ARRAY,  ROOT) ; 
CHECK_NW  (N_ARRAY,  ROOT) ; 
CHECK_N  (N_ARRAy,  ROOT) ; 
CHECK_NE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_N  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NE  (N_ARRAY,  ROOT) ; 


when  2  *> 

CHECK_UP_NE  (N_ARRAY,  ROOT) ; 
CHECK_UP_E  (N_ARRAY,  ROOT) ; 
CHECK_UP_SE  (N_ARRAY,  ROOT) ; 
CHECK_NE  (N_ARRAY,  ROOT) ; 
CHECK_E  (N_ARRAY,  ROOT) ; 
CHECK_SE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_E  {N_ARRAY,  ROOT) ; 
CHECK_DOWN_SE  (N_ARRAY,  ROOT) ; 


when  3  *> 

CHECK_UP_SE  (N_ARRAY,  ROOT) ; 
CHECK_UP_S  (N_ARRAY,  ROOT); 
CHECK_UP__SW  (N_ARRAY,  ROOT)  ; 
CHECK_SE  (N_ARRAY,  ROOT) ; 
CHECK_S  (N_ARRAY,  ROOT); 
CHECK_SW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_SE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_S  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_SW  (N_ARRAY,  ROOT) ; 


when  4  => 

CHECK_UP_SW  (N_ARRAY,  ROOT) ; 
CHECK_UP_W  (N_ARRAY,  ROOT) ; 
CHECK_UP_NW  (N__ARRAY,  ROOT)  ; 
CHECK_SW  (N_ARRAY,  ROOT) ; 
CHECKJW  (N_ARRAY,  ROOT) ; 
CHECKJNW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_SW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_W  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NW  (N_ARRAY,  ROOT) ; 

when  others  => 
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null 


end  case; 
end  F_MOVES; 

procedure  FREE  is  new  UNCHECKED_DEALLOCATION  (LIST, 
LIST  PTR) ; 


procedure  F__PATH  (N_ARRAY  :  in  out  NODE_ARRAY)  is 
ROOT  :  LIST  PTR  :=  WAVE; 


begin 

while  ROOT  /=  null  loop 
F_MOVES  (N_ARRAY,  ROOT) ; 

ROOT  :=  WAVE. NEXT; 

FREE  (WAVE) ; 

WAVE  ;*  ROOT; 
end  loop; 

if  GOAL_FOUND  then 
return; 
end  if; 

WAVE  :=  NEW_WAVE; 

NEW_WAVE  ;=  null; 

LAST__NEW__WAVE  :=  null; 
end  F_PATH; 

procedure  DO_SEARCH  is 

N_ARRAY  ;  NODE_ARRAY  (l..MAX_ROW,  l..MAX_COL, 

1..MAXDEP,  1..MAXHDG); 


begin 

START_TIME  :=  CLOCK; 

READ_TER  (N_ARRAY) ; 
while  WAVE  /=  null  loop 
F_PATH  (N_ARRAY); 
exit  when  GOAL_FOUND; 
end  loop; 

P_PATH  (N_ARRAY)  ; 

END_TIME  :=  CLOCK; 

T  TIME  :=  END  TIME  -  START  TIME; 
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NEW_LINE; 

FLOAT I 0 . put  ( FLOAT ( T_T IME ) ) ; 
put  ("  seconds  of  cpu  time."); 
end  DO_SEARCH; 

end  PATH; 
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— NAME  ;  J.  Bons ignore,  Jr. 

—DATE  :  22  Jan,  1991 

—REVISED  : 

— T I TLE  :  THE_MOVE . ADS 

— DESCRIPTION  :  Contains  the  procedures  for  checking  and 
;  processing  individual 
:  nodes  sent  from  F_MOVES. 

— CALLS 

—NOTES  : 

with  TEXT_IO,  GLOBALS; 
use  TEXT_IO,  GLOBALS; 

package  THE_MOVE  is 

procedure  NNC  (ELEMENT  :  in  LIST_PTR; 

HEAD  :  in  out  LIST_PTR; 

TAIL  :  in  out  LIST_PTR) ; 

procedure  GROW_TEND  (ELE  :  in  out  LIST_PTR; 

N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CK_STATE  (NEW_LOC  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE__ARRAY; 

NEW_INC  ;  in  out  INT_TYPE; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_N  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_N  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  ;  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_N  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  ;  in  out  LIST_PTR) ; 

procedure  CHECK_NE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_NE  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST  PTR) ; 
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procedure  CHECK_DOWN_NE  (N_ARRAY  ;  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_E  (N__ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_E  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_E  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_S  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_S  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_S  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_SW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_SW  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  ;  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_SW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_W  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST  PTR) ; 
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procedure  CHECK_UP_W  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_W  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_NW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_NW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_NW  (N_ARRAY  :  in  out  NODE_ARRAYj 

ROOT  :  in  out  LIST_PTR) ; 

end  THE  MOVE; 


— NAME  :  J.  Bonsignore/  Jr. 

—DATE  :  22  Jan,  1991 

—REVISED  ; 

—TITLE  ;  THE_MOVE.ADB 

—DESCRIPTION  :  The  package  body  for  THE_MOVE 


with  TEXT_IO,  GLOBALS; 
use  TEXT_IO,  GLOBALS; 

package  body  THE_MOVE  is 

procedure  NNC  (ELEMENT  :  in  LIST_PTR; 

HEAD  :  in  out  LIST_PTR; 

TAIL  :  in  out  LIST_PTR)  is 

Creates  and  performs  list  maintanence. 
begin 

if  HEAD  =  null  then 

HEAD  :=  ELEMENT; 

TAIL  :=  ELEMENT; 

else 

TAIL. NEXT  :=  ELEMENT; 

TAIL  :=  TAIL.NEXT; 

end  if; 
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end  NNC; 


procedure  GROW_TEND  (ELE  :  in  out  LIST_PTR; 

N_ARRAY  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR)  is 

Determines  if  nodes  have  been  previously  processed  and  if 
necessary  reassignes. 

procedure  ASSIGN  (N_ARRAY  :  in  out  NODE_ARRAY; 

ELE  :  in  out  LIST_PTR; 

ROOT  :  in  out  LIST_PTR)  is 

Once  a  node  is  determined  to  be  a  legal  move  its 
attributes 

are  assigned,  and  the  GOAL  is  checked  for  completion, 
begin 

N_ARRAY(ELE.L0C(1) ,ELE.L0C(2) ,ELE.LOC(3) , 
ELE.LOC (4) ) .PARENT  :=  ROOT. LOG; 
N_ARRAY(ELE.L0C(1) ,ELE.L0C(2) , ELE. LOG (3) , 
ELE.L0G(4) ) .TEND_LEN  ;=  ELE.ING  + 
N_ARRAY(ROOT.LOG(l) ,R00T.L0G(2) ,ROOT.LOC(3) , 
ROOT .  LOG  ( 4 ) )  .  TEND__LEN  ; 
if  ELE. LOG  =  GOAL  then 

GOAL_FOUND  :=  TRUE; 

end  if; 

NNG  (ELE,  NEW_WAVE,  NW_TAIL) ; 
end  ASSIGN; 


begin 

if  N_ARRAY(ELE.LOG(l) ,ELE.LOG(2) ,ELE.LOG(3) , 
ELE.L0G(4) ) .TEND_LEN  =  0  then 
ASSIGN  (N_ARRAY,  ELE,  ROOT) ; 
elsif  N_ARRAY(ELE.LOG(l)  ,ELE.LOG(2)  ,ELE.LOG(3)  , 
ELE . LOG ( 4 ) ) . TEND_LEN  > 

(N_ARRAY (ROOT.LOG (1) , ROOT. LOG (2) , ROOT. LOG (3) , 
ROOT.LOG(4)  )  .TEND__LEN  +  ELE.ING)  then 
ASSIGN  (N_ARRAY,  ELE,  ROOT) ; 
end  if; 
end  GROW_TEND; 

procedure  GK_STATE  (NEW_LOG  :  in  out  LOG_ARRAY; 
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N_ARRAY  ;  in  out  NODE_AEUyiy; 

NEW_INC  :  in  out  INT_TYPE; 

ROOT  :  in  out  LIST_PTR)  is 

Checks  if  the  node  is  an  obstacle.  If  not  it  calls  the 
GROW_TEND  procedure. 

NEW  ELE  :  LIST  PTR; 


begin 

if  N_ARRAY(NEW_LOC(l) ,  NEW_L0C(2),  NEW_L0C(3), 
NEW_L0C(4) ) .STATE  =  0  then 
NEW_ELE  :=  new  LIST; 

NEW_ELE.LOC  :=  NEW_LOC; 

NEW_ELE.INC  :=  NEW_INC; 

GROW_TEND  (NEW_ELE,  N_ARRAY,  ROOT) ; 
end  if; 
end  CK_STATE; 

The  remaining  procedures  are  for  individual  "moves."  The 
coordinates  are  calculated  and  a  cost  is  assigned  to  the 
move.  Each  calls  CRISTATE. 

procedure  CHECK_N  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOC  :  LOC  ARRAY  ;=  ROOT.LOC; 


begin 

IF  NEW_L0C(1)  >  1  then 

NEW_LOC(l)  :=  NEW_LOC(l)  -  1; 

CK_STATE  (NEW_LOC,  N_ARRAY,  CARD_COST,  ROOT) ; 
end  if; 
end  CHECK_N; 

procedure  CHECK_UP_N  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOC  ;  LOC  ARRAY  :=  ROOT.LOC; 


begin 

IF  NEW_LOC(l)  >  1  and  NEW_L0C(3)  >  1  then 
NEW  LOC(l)  ;=  NEW  LOC(l)  -  1; 
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NEW_L0C(3)  :=  NEW_L0C(3)  -  1; 

CK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_UP_N; 

procedure  CHECK_DOWN_N  (N_ARRAy  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_L0G(1)  >  1  and  NEW_LOG(3)  <  MAX_DEP  then 
NEW_L0G(1)  :=  NEW_LOG(l)  -  1; 

NEW_L0G(3)  :=  NEW_LOG(3)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_N; 

procedure  GHEGK_NE  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  :  LOG_ARRAY  :=  ROOT.LOG; 

begin 

if  NEW_L0C(1)  >  1  and  NEW_L0G(2)  <  MAX_GOL  then 
NEW_L0G(1)  :=  NEW_LOG(l)  -  1; 

NEW_L0G(2)  :=  NEW_LOG(2)  +  1; 

if  ROOT.LOG (4)  =  1  then 
NEW_LOG(4)  :=  2; 

else 

NEW_L0G(4)  ;=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 
end  GHEGK_NE; 

procedure  CHECK_UP_NE  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  ;  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW  LOC(l)  >  1  and  NEW  LOG (2)  <  MAX  GOL  and 
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NEW_L0C(3)  >  1  then 

NEW_L0C(1)  :=  NEW_L0C(1)  -  1; 

NEW_L0C(2)  :=  NEW_L0C(2)  +  1; 

NEW_L0C(3)  :=  NEW_L0C(3)  -  1; 

if  ROOT. LOG (4)  =  1  then 
NEW_LOC{4)  :=  2; 

else 

NEW_LOC(4)  :=  1; 

end  If; 

CK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_UP_NE; 

procedure  CHECK_DOWN_NE  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT. LOG; 


begin 

IF  NEW_LOC(l)  >  1  and  NEW_LOC(2)  <  MAX_COL  and 
NEW_LOG(3)  <  MAX_DEP  then 

NEW_LOG(l)  :=  NEW_LOC(l)  -  1; 

NEW_LOG(2)  :=  NEW_LOC(2)  +  1; 

NEW_LOC(3)  NEW_LOC(3)  +  1/ 

if  ROOT. LOG (4)  =  1  then 
NEW__LOG(4)  :=  2; 

else 

NEW_LOC(4)  :=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_NE; 

procedure  GHEGK_E  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  ;  LOG  ARRAY  ;=  ROOT.LOG; 


begin 

IF  NEW_LOG(2)  <  MAX_GOL  then 
NEW_LOG(2)  ;=  NEW_LOG(2)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  GARD_GOST,  ROOT) ; 
end  if; 
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end  CHECK  E; 


procedure  CHECK_UP_E  (N_ARRAY  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOC  :  LOC  ARRAY  :=  ROOT.LOC; 


begin 

IF  NEW_LOC(2)  <  MAX_COL  and  NEW_LOC(3)  >  1  then 
NEW_LOC(2)  :=  NEW_LOC(2)  +  1; 

NEW_LOC(3)  :=  NEW_LOC(3)  -  1; 

CK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK  UP  E; 


procedure  CHECK_DOWN_E  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOC  ;  LOC  ARRAY  :=  ROOT.LOC; 


begin 

IF  NEW_LOC<2)  <  MAX_COL  and  NEW_LOC(3)  <  MAX_DEP 
then 

NEW_LOC(2)  :=  NEW_LOC(2)  +  1; 

NEW_LOC(3)  :=  NEW_LOC(3)  +  1; 

CK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_DOWN_E; 

procedure  CHECK_W  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOC  :  LOC  ARRAY  ;=  ROOT.LOC; 


begin 

IF  NEW_LOC<2)  >  1  then 

NEW_LOC(2)  :=  NEW_LOC(2)  -  1; 

CK_STATE  (NEW_LOC,  N_ARRAY,  CARD_COST,  ROOT) ; 
end  if; 
end  CHECK_W; 

procedure  CHECK_UP_W  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST  PTR)  is 
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NEW  LOC  ;  LOG  ARRAY  :=  ROOT. LOG; 


begin 

IF  NEW_LOG(2)  >  1  and  NEW_LOG(3)  >  1  then 
NEW_LOG(2)  :=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  :=  NEW_LOG(3)  -  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_UP_W; 

procedure  GHEGK_DOWN_W  (N_ARRAy  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(2)  >  1  and  NEW_LOG(3)  <  MAX_DEP  then 
NEW_LOG(2)  :=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  :=  NEW_LOG(3)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_W; 

procedure  GHEGK_S  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  <  MAX_ROW  then 
NEW_L0G<1)  ;=  NEW_LOG(l)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  GARD_GOST,  ROOT) ; 
end  if; 
end  GHEGK_S; 

procedure  GHEGK_UP_S  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOC  ARRAY  ;=  ROOT.LOG; 


begin 

IF  NEW_LOC(l)  <  MAX  ROW  and  NEW  LOC (3)  >  1  then 


70 


NEW_L0C(1)  :=  NEW_L0C(1)  +  1; 

NEW_L0C(3)  :=  NEW_L0C(3)  -  1; 

CK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_UP_S; 

procedure  CHECK_DOWN_S  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  ;  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_L0G(1)  <  MAX_ROW  and  NEW_LOG(3)  <  MAX_DEP 
then 

NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

NEW_LOG(3)  :=  NEW_LOG(3)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_S; 

procedure  GHEGK_SE  {N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  :  LOG_ARRAY  ;*  ROOT.LOG; 

begin 

IF  NEW_LOG(l)  <  MAX_ROW  and  NEW_LOG(2)  <  MAX_GOL 
then 

NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

NEW_LOG(2)  :=  NEW_LOG(2)  +  1; 

if  ROOT.LOG (4)  =  2  then 
NEW_LOG(4)  :=  3; 

else 

NEW_LOG(4)  :=  2; 

end  if; 

GK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 
end  GHEGK_SE; 

procedure  GHEGK_UP_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


71 


begin 


IF  NEW_L0C(1)  <  MAX_ROW  and  NEW_L0C<2)  <  MAX_COL 
and  NEW_L0C(3)  >  1  then 

NEW_L0C(1)  :=  NEW_L0C(1)  +  1; 

NEW_L0C(2)  :=  NEW_L0C(2)  +  1; 

NEW_L0C(3)  :=  NEW_L0C(3)  -  1; 

if  ROOT. LOG (4)  =  2  then 
NEW_LOC(4)  :=  3; 

else 

NEW_LOC(4)  :=  2; 

end  if; 

CK_STATE  (NEW_LOC,  N__ARRAY,  DIAG_COST,  ROOT)  ; 
end  if; 

end  CHECK_UP_SE; 

procedure  CHECK_DOWN_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  <  MAX_ROW  and  NEW_LOG(2)  <  MAX__GOL 
and  NEW_L0C(3)  <  MAX_DEP  then 
NEW_LOG(l)  :=  NEW_LOC(l)  +  1; 

NEW_LOG<2)  :=  NEW_LOC(2)  +  1; 

NEW_LOG(3)  ;=  NEW_LOC(3)  +  1; 
if  ROOT.LOG (4)  =  2  then 
NEW_LOG(4)  :=  3; 

else 

NEW_LOG(4)  :=  2; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_SE; 

procedure  GHEGK_SW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW  LOG(l)  <  MAX  ROW  and  NEW  LOG  (2)  >  1  then 


72 


NEW_L0C(1)  :=  NEW_L0C(1)  +  1; 

NEW_L0C(2)  :=  NEW_L0C(2)  -  1; 
if  ROOT. LOG (4)  =  3  then 
NEW_LOC{4)  ;=  4; 

else 

NEW_LOC{4)  :=  3; 

end  if; 

CK_STATE  (NEW_LOC,  N_ARRAy,  DIAG_COST,  ROOT) ; 
end  if; 
end  CHECK_SW; 

procedure  CHECK_UP_SW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOC  :  LOC_ARRAY  ;=  ROOT. LOG; 

begin 

IF  NEW_LOG(l)  <  MAX_ROW  and  NEW_LOG(2)  >  1  and 
NEW_LOG(3)  >  1  then 

NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

NEW_LOG(2)  :=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  ;=  NEW_LOG(3)  -  1; 

if  ROOT.LOG (4)  =  3  then 
NEW_LOG(4)  :=  4; 

else 

NEW_LOG(4)  :*  3; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_UP_SW; 

procedure  GHEGK_DOWN_SW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  ;  LOG_ARRAy  :=  ROOT.LOG; 

begin 

IF  NEW_LOG(l)  <  MAX_ROW  and  NEW_LOG(2)  >  1  and 
NEW_LOG(3)  <  MAX_DEP  then 

NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

NEW_L0G(2)  :=  NEW_LOG(2)  -  1; 

NEW_L0G(3)  ;=  NEW_LOG(3)  +  1; 

if  ROOT.LOG (4)  =  3  then 


NEW_L0C(4)  :=  4; 

else 

NEW_L0C(4)  :=  3; 

end  if; 

CK_STATE  (NEW_LOC,  N_ARRAy,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_DOWN_SW; 

procedure  CHECK_NW  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOC  ;  LOC_ARRAy  :=  ROOT. LOG; 

begin 

IF  NEW_LOC(l)  >  1  and  NEW_LOC(2)  >  1  then 
NEW_LOC(l)  :=  NEW_L0C(1)  -  1; 

NEW_LOC(2)  :=  NEW_L0C{2)  -  1; 
if  ROOT. LOG (4)  =  1  then 
NEW_LOG(4)  :=  4; 

else 

NEW_LOG(4)  :=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAy,  DIAG__COST,  ROOT)  ; 
end  if; 
end  GHEGK_NW; 

procedure  GHEGK_UP_NW  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  ;  in  out  LIST_PTR)  is 

NEW_LOG  :  LOG_ARRAy  ;=  ROOT.LOG; 

begin 

IF  NEW_LOC(l)  >  1  and  NEW_L0C(2)  >  1  and  NEW_LOG(3) 
>  1  then 

NEW_LOG(l)  :=  NEW_L0G(1)  -  1; 

NEW_L0G(2)  :=  NEW_L0G(2)  -  1; 

NEW_L0G(3)  ;=  NEW_L0G(3)  -  1; 

if  ROOT.LOG (4)  =  1  then 
NEW_LOG(4)  :=  4; 

else 

NEW_LOC(4)  :=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAy,  DIAG  GOST,  ROOT) ; 
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end  if; 

end  CHECK_UP_NW; 

procedure  CHECK_DOWN_NW  (N_ARRAY  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  >  1  and  NEW_LOG(2)  >  1  and  NEW_L0G(3) 

< 

MAX_DEP  then 

NEW_LOG(l)  :=  NEW_LOG(l)  -  1; 

NEW_L0G(2)  :=  NEW_L0C(2)  -  1; 

NEW_L0G(3)  :=  NEW_L0G(3)  +  1; 

if  ROOT.LOG (4)  =  1  then 
NEW_LOG(4)  :=  4; 

else 

NEW_LOC(4)  :=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_NW; 
end  THE  MOVE; 
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APPENDIX  E  (pan  1) 


Table  1:  Data  Dictionary  for  the  TENDRILWP  Search 


PACKAGE 

ESQCEBUBE 

VARIABLE 

TYPE 

PATHWP 

GET  DATA 

FILE_NAME 

STRING  (1..12) 

NAME_LEN 

INT_TYPE 

CONT 

CHARACTER  :=  ‘Y’ 

P  PATH 

NEXT_LOC 

LOC_ARRAY 

F  MOVES 

HEADING 

INT.TYPE  :=  ROOTJX)C  (4) 

F  PATH 

ROOT 

LIST_FTR:=WAVE 

DO  SEARCH 

N_ARRAY 

NODE.ARRAY  (l..MAX_ROW, 
L.MAX_COL,‘ 

1.. MAX_DEP, 

1.. MAX_HDG) 
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DATA  FLOW  DIAGRAM  for  the  TENDRILWP  SEARCH  (part  2) 


NEW„ELE 
N  AlQlAY 
ROOT 


NE>^OC 
N  ARRAY 
COST 
ROOT 


N  ARRAY 

EDE 

ROOT 


FI  F 

Acwr'MX  NEW  WAVE 
ASSIGN]  jsi^ 


TENDRILWP  SEARCH  CODE  (part  3) 


—NAME 
—DATE 
—REVISED 
—TITLE 
— DESCRIPTION 
waypoints . 
—CALLS 
—NOTES 


J.  Bons ignore,  Jr. 

22  Jan,  1991 

TENDRILWP .ADA 

Main  procedure  for  the  Tendril  search  with 
GET_DATA,  and  DO_SEARCH  in  the  PATHWP  package 


with  TEXT_IO,  GLOBALS,  PATHWP; 
use  TEXT_IO,  GLOBALS,  PATHWP; 

procedure  TENDRILWP  is 

begin 

GET_DATA; 

DO_SEARCH; 
end  TENDRILWP; 
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— NAME  :  J.  Bonsignore,  Jr. 

—DATE  :  22  Jan,  1991 

—REVISED  : 

—TITLE  :  PATHWP.ADS 

— DESCRIPTION  :  Contains  the  major  procedures  for  the  Tendril 
with  waypoint 

:  search 

—CALLS 

—NOTES  : 


with  TEXT_IO,  GLOBALS,  THE_MOVE,  UNCHECKED_DEALLOCATION; 
use  TEXT_IO,  GLOBALS,  THE_MOVE; 

package  PATHWP  is 

procedure  DO_SEARCH; 

procedure  GET__DATA; 

procedure  READ_TER  (N_ARRAY  :  in  out  NODE_ARRAY) ; 
procedure  P_PATH  (N_ARRAY  :  in  out  NODE_ARRAY) ; 
end  PATHWP; 


—NAME 

—DATE 

—REVISED 

—TITLE 

—DESCRIPTION 

—NOTES 


J.  Bonsignore,  Jr. 

22  Jan,  1991 

PATHWP. ADB 

Package  body  for  PATHWP  package 
Differences  from  PATH  package:  GET_DATA 
makes  a 

list  of  waypoints,  P_PATH  creates  a  list  of 
records  in  each  path  segment  and  writes  to 
file  only  (no  screen  output),  RESET_ALL 
resets  global  variables  to  initial  settings 
after  each  path  segment  is  completed. 


package  body  PATHWP  is 


procedure  GET  DATA  is 


Opens  the  terrain  data  file,  reads  in  the  array  dimensions 
and  takes  the  starting  and  goal  coordinates  as  input. 

FILE_NAME  ;  STRING  (1..12); 

NAME_LEN  :  INT_TYPE; 

CONT  :  CHARACTER  :=  'Y'; 

begin 

put  ("Enter  the  name  of  data  file;  "); 
get_line  (FILE_NAME,  NAME_LEN) ; 

FILE_NAME  (  (NAME_LEN  +  1)..12)  :=  (Others  =>  ' 
FILE_NAME  (9.. 12)  :=  ".DAT"; 

OPEN  (DATA_FILE,  MODE  =>  IN_FILE,  NAME  =>  FILE_NAME) ; 
INT_IO.get  (DATA_FILE,  MAX_ROW) ; 

INT_IO.get  (DATA_FILE,  MAX_COL) ; 

INT_I 0 . ge t  ( DATA_F I LE ,  MAX_DEP ) ; 

INT_IO.get  (DATA_FILE,  MAX_HDG) ; 

NEW_LINE; 

WAVE_HEAD  :=  new  LIST; 

WAVE_TAIL  WAVE_HEAD; 
while  CONT  =  'y'  or  CONT  *  'Y'  loop 
put  ("Enter  the  position  row:  "); 

INT_IO . get  (WAVE_TAIL . LOC ( 1 ) ) ; 

NEW_LINE; 

put  ("Enter  the  position  col;  "); 

INT_IO . get  ( WAVE_TAIL . LOC ( 2 ) ) ; 

NEW_LINE; 

put  ("Enter  the  position  dep;  ”) ; 

INT_IO . get  (WAVE_TAIL . LOC ( 3 ) ) ; 

NEW_LINE; 

put  ("Enter  the  position  hdg;  "); 

INT_IO . get  (WAVE_TAIL . LOC (4) ) ; 

NEW_LINE; 

put  ("Enter  another  position?"); 
get  (CONT) ; 

if  CONT  =  'y*  or  CONT  =  'Y'  then 
WAVE_TAIL.NEXT  ;=  new  LIST; 

WAVE_TAIL  ;=  WAVE_TAIL.NEXT; 
end  if; 
end  loop; 


end  GET_DATA; 

procedure  READ_TER  (N_ARRAY  :  in  out  NODE_ARRAY)  is 

—  Reads  the  terrain  data  from  the  data  file  and  initializes 
”  the  N_ARRAY . 

begin 

for  ROW  in  l..MAX_ROW  loop 
for  COL  in  l..MAX_COL  loop 

for  DEP  in  l..MAX_DEP  loop 
for  HDG  in  l..MAX_HDG  loop 
INT_IO.get  (DATA_FILE,  N_ARRAY (ROW,  COL,  DEP, 

HDG) .STATE) ; 

N_ARRAY(ROW,  COL,  DEP,  HDG) . TEND_LEN  :=  0 
N_ARRAY(ROW,  COL,  DEP,  HDG) .PARENT  := 

(0,0,  0,0)  ; 

end  loop; 
end  loop; 
end  loop; 
end  loop; 

close  (DATA_FILE) ; 
end  READ_TER; 

procedure  P_PATH  (N__ARRAY  :  in  out  NODE_ARRAY)  is 
Creates  a  list,  THE__PATH  and  writes  it  to  a  file. 

NEXT_LOC  :  LOC_ARRAY; 
begin 

if  GOAL_FOUND  and  THE_PATH  =  null  then 
THE_PATH  :=  new  LIST; 

THE_PATH.LOC  ;=  GOAL; 
loop 

NEXT_LOC  :*  N_ARRAY(GOAL(l) ,  GOAL (2),  GOAL (3), 

GOAL (4) ) .PARENT; 
THE_PATH_CURRENT  :=  new  LIST; 

THE_PATH_CURRENT . LOC  :=  NEXT_LOC; 
THE_PATH_CURRENT.NEXT  :=  THE_PATH; 

THE_PATH  ;=  THE_P ATH_CURRENT ; 

GOAL  ;=  NEXT_LOC; 

exit  when  THE  PATH. LOC  =  START; 


end  loop; 

elsif  GOAL_FOUND  and  THE_PATH  /=  null  then 
loop 

NEXT_LOC  :=  N_ARRAY(G0AL(1) ,  GOAL (2),  GOAL  (3), 

GOAL (4) ) .PARENT; 
THE_PATH_CURRENT  :=  new  LIST; 

THE_PATH_CURRENT . LOG  ;=  NEXT_LOC; 
THE_PATH_CURRENT.NEXT  ;=  THE_PATH; 

THE_PATH  :=  THE_PATH_CURRENT; 

GOAL  :=  NEXT_LOC; 
exit  when  THE_PATH.LOC  =  START; 
end  loop; 
else 

put  ("PATH  NOT  FOUND"); 
new_line; 
end  if; 

while  THE_PATH  /=  null  loop 

INT_IO . put  (PATH_FILE,  THE_PATH . LOG ( 1 ) ) ; 

INT_I 0 . put  ( PATH_F I LE ,  THE_P ATH . LOG ( 2 ) ) ; 

INT_IO . put  (PATH_FILE ,  THE_PATH . LOG ( 3 ) ) ; 
INT_IO.put  (PATH_FILE,  THE_PATH . LOG ( 4 ) ) ; 
new_line  (PATH_FILE) ; 

THE_PATH  ;=  THE_P ATH. NEXT; 
end  loop; 

put  (PATH_FILE,  "END  PATH  SEGMENT"); 
new_line  (PATH_FILE) ; 
end  P_PATH; 

procedure  F_MOVES  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

Using  the  heading  of  the  current  node  being  processed, 
F_MOVES  determines  the  legal  moves  that  can  be  made  and 
calls  the  GHEGK_???  procedure  in  the  THE_MOVE  package. 

HEADING  ;  INT  TYPE  :=  ROOT. LOG (4); 


begin 

case  HEADING  is 
when  1  => 

GHEGK_UP_NW  (N_ARRAY,  ROOT) ; 
GHEGK_UP_N  (N_ARRAY,  ROOT) ; 
GHEGK  UP  NE  (N  ARRAY,  ROOT) ; 
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CHECK_NW  (N_ARRAY,  ROOT) ; 
CHECK_N  (N_ARRAY,  ROOT) ; 
CHECK_NE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_N  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NE  (N_ARRAY,  ROOT) ; 

when  2  => 

CHECK_UP_NE  (N_ARRAY,  ROOT) ; 
CHECK_UP_E  {N_ARRAY,  ROOT) ; 
CHECK_UP_SE  (N_ARRAY,  ROOT) ; 
CHECK_NE  (N_ARRAY,  ROOT); 
CHECKJE  (N_ARRAY,  ROOT) ; 
CHECK_SE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_E  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_SE  (N_ARRAY,  ROOT) ; 


when  3  => 

CHECK_UP_SE  (N_ARRAY,  ROOT) ; 
CHECK_UP_S  (N_ARRAY,  ROOT) ; 
CHECK__UP_SW  (N_ARRAY,  ROOT); 
CHECK_SE  (N_ARRAY,  ROOT); 
CHECK__S  (N_ARRAY,  ROOT)  ; 
CHECK__SW  (N_ARRAY,  ROOT)  ; 
CHECK__DOWN_SE  (N_ARRAY,  ROOT)  ; 
CHECK_DOWN_S  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_SW  (N_ARRAY,  ROOT) ; 


when  4  => 

CHECK_UP_SW  (N_ARRAY,  ROOT) ; 
CHECK_UP_W  (N__ARRAy,  ROOT)  ; 
CHECK_UP_NW  (N_ARRAY,  ROOT) ; 
CHECK_SW  {N_ARRAY,  ROOT) ; 
CHECK_W  (N_ARRAY,  ROOT) ; 
CHECK__NW  (N_ARRAY,  ROOT)  ; 
CHECK_DOWN_SW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_W  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NW  (N_ARRAY,  ROOT) ; 

when  others  => 
null; 
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end  case; 
end  F_MOVES; 

procedure  FREE  is  new  UNCHECKED_DEALLOCATION  (LIST, 
LIST_PTR) ; 

Clears  old  memory  space. 

procedure  F_PATH  (N_ARRAy  :  in  out  NODE_ARRAY)  is 

Processes  the  WAVE  list  in  order  calling  the  F_MOVE 
procedure.  Also  reinitializes  the  WAVE  list. 

ROOT  :  LIST  PTR  :*  WAVE; 


begin 

while  ROOT  /=  null  loop 
F_MOVES  (N_ARRAy,  ROOT) ; 

ROOT  :=  WAVE. NEXT; 

FREE  (WAVE) ; 

WAVE  ;=  ROOT; 
end  loop; 

FREE  (WAVE); 

if  GOAL_FOUND  then 
return; 
end  if; 

WAVE  :=  NEW_WAVE; 

NEW_WAVE  ;*  null; 

LAST_NEW_WAVE  ;=  null; 
end  F_PATH; 

procedure  RESET_ALL  (N_ARRAy  :  in  out  NODE_ARRAy)  is 

—  Used  to  reset  the  various  attributes  in  N_ARRAy  changed 
during  each  path  segment  search.  This  allows  a  path  to 

—  go  to  a  waypoint/goal  and  return  using  many  of  the  nodes 
previously  used  in  the  outbound  trip. 

begin 

GOAL_FOUND  ;=  FALSE; 
for  ROW  in  l..MAX_ROW  loop 
for  COL  in  l..MAX_COL  loop 
for  DEP  in  1..MAX  DEP  loop 
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for  HDG  in  l..MAX_HDG  loop 

N_ARRAy (ROW, COL, DEP,HDG) .PARENT  :=  (others  =>  0)  ; 

N_ARRAy ( ROW , COL , DEP , HDG ) . TEND_LEN  : =  0 ; 
end  loop; 
end  loop; 
end  loop; 
end  loop; 
end  RESET  ALL; 


procedure  DO_SEARCH  is 

—  Calls  the  major  procedures  in  the  search  and  creates  the 

—  N_ARRAY. 

N_ARRAY  :  NODE_ARRAY  (l..MAX_ROW,  l..MAX_COL, 

1..MAX  DEP,  1..MAX  HDG); 


begin 

READ_TER  (N_ARRAY) ; 

CREATE  (PATH_FILE,  NAME  =>  "path . file" ) ; 
loop 

exit  when  WAVE_HEAD.NEXT  =  null; 

WAVE  ;=  new  LIST; 

WAVE.LOC  :=  WAVE__HEAD.LOC; 

START  ;=  WAVE__HEAD  .LOC; 

GOAL  :=  WAVE_HEAD. NEXT. LOC; 

while  WAVE  /=  null  and  NOT  GOAL_FOUND  loop 
F_PATH  (N_ARRAY) ; 
end  loop; 

P_PATH  (N_ARRAY)  ; 

RESET_ALL  (N_ARRAY) ; 

WAVE_HEAD  :=  WAVE_HEAD . NEXT ; 
end  loop; 

CLOSE  (PATH_FILE) ; 
end  DO_SEARCH; 
end  PATHWP; 
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APPENDIX  F  (part  1) 

Table  1:  Data  Dictionary  for  the  DIRECTION  Search 


PACKAGE 


fatWMeiKi 


VARIABLE 


GLOBALS 


DATA.FILE 


LOC.ARRAY 


NODE  ARRAY 


START_TIME 

END_TIME 

T_TIME 


MAX_ROW 
MAX.OOL 
MAX.DEP 
MAX.HDG 
DIAG_COST  :=  120 
CARD_COST  :=  100 


ACTIVE 

TAIL 

CLEAR 

PATH 


START 

GOAL 


GOAL.FOUND 


FILE_TYPE 


array  (1..4)  of  INT_TYPE 


record  {LOC :  LOC.ARRAY 
NEXT :  UST.PTR) 


record  {STATE :  INT.TYPE 
DIST :  INT_TYPE  :=  0 
INC:INT_TYPE;=0 
NEXT :  LOC_ARRAY  := 
(9.9.9.9)) 


array  (INT_TYPE  range  o, 
INT_TYPE  range  o, 
INT.TYPE  range  o, 
INT_TYPE  range  o)  of  NODE 


TIME 


DURATION 


LIST_PTR:=null 


LOC.ARRAY 


BOOLEAN  :=  FALSE 
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Table  1:  Data  Dicticmary  for  the  DIRECTION  Search 


PACKAGE 

PRQCEPURE 

VARIABLE 

TYPE 

B 

GET  DATA 

FILE_NAME 

STRING  (1..12) 

NAME_LEN 

INT_TYPE 

P  PATH 

P_TAIL 

LIST_PTR  :=  null 

■  3  ici 

HDG :  ACnVE_LOC  (4) 

INT_TYPE 

L 

NL 

LOC.ARRAY  :=  ACTPv'E XOC 

F_TAIL 

LIST_PTR:=null 

DO  DIR 

N.ARRAY 

NODE.ARRAY  (L.MAX.ROW, 

1.. MAX_COL, 

1.. MAX_DEP. 

1.. MAX_HDG) 
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DIRECTION  SEARCH  CODE  (part  3) 


“NAME 
— DATE 
— REVISED 
—TITLE 
—DESCRIPTION 
— CALLS 

— NOTES 


:  J.  Bonsignore,  Jr. 

;  22  Jan,  1991 

:  DIRECTION. ADA 

;  Main  procedure  for  the  Direction  search 
GET_DATA  and  DO_DIR  in  the  B  package  (like  PATH 
:  package) . 


with  TEXT_IO,  A,  B; 
use  TEXT_IO,  A,  B; 

procedure  DIRECTION  is 

begin 

GET_DATA; 

DO_DIR; 

end  DIRECTION; 
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— NAME  :  J.  Bonsignore,  Jr. 

—DATE  :  22  Jan,  1991 

—REVISED  ; 

—TITLE  ;  A. ADS 

— DESCRIPTION  ;  Global  variables  for  the  Direction  search 
—CALLS  : 

—NOTES  ; 


with  TEXT_IO,  CALENDAR; 
use  TEXT_IO,  CALENDAR; 

package  A  is 

subtype  INT_TYPE  is  INTEGER; 

package  INT_IO  is  new  INTEGER_IO  (INT_TYPE) ; 
package  FLOATIO  is  new  FLOAT_IO  (FLOAT) ; 
use  INT_IO,  FLOATIO; 

type  LOC_ARRAY  is  array  (1..4)  of  INT_TYPE; 
type  LIST; 

type  LISTJPTR  is  access  LIST; 
type  LIST  is 
record 

LOC  ;  LOC_ARRAY; 

NEXT  ;  LIST_PTR; 
end  record; 

ACTIVE  :  LIST_PTR; 

TAIL  ;  LIST_PTR; 

CLEAR  ;  LIST_PTR; 

PATH  :  LIST_PTR; 

type  NODE  is 
record 

STATE  :  INT_TYPE  :=  0; 

DIST  ;  INT_TYPE  :=  0; 

INC  :  INT_TYPE  :=  0; 

NEXT  :  LOC_ARRAY  ;=  (9,  9,9,9)  ; 
end  record; 
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type  NODE_ARRAY  is  array  (INT_TYPE  range  <>,  INT_TYPE  range 

<>,INT_TYPE  range  <>,  INT_TYPE 
range  <>)  of  NODE; 


DATA_FILE 

;  FILE_TYPE; 

START_TIME 

;  TIME; 

END_TIME 

;  TIME; 

T_TIME 

:  DURATION; 

MAX_ROW  : 

INT_TYPE; 

MAX_COL  : 

INT_TYPE; 

MAX_DEP  ; 

INT_TYPE; 

MAX_HDG  : 

INT_TYPE  :=  4; 

DIAG_COST 

;  INT_TYPE  := 

120; 

CARD_COST 

:  INT_TYPE  :  = 

100; 

GOAL  :  LOC_ARRAY; 

START  :  LOC_ARRAY; 

end  A; 
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— NAME  :  J.  Sons ignore,  Jr. 

—DATE  :  22  Jan,  1991 

—REVISED  : 

—TITLE  :  B.ADS 

— DESCRIPTION  ;  This  package  is  similar  to  the  PATH  package 
in  other  programs. 

:  It  contains  the  major  procedures  for  the 

Direction  search. 

—CALLS  : 

—NOTES  : 


with  TEXT_IO,  A,  C,  UNCHECKED_DEALLOCATION,  CALENDAR; 
use  TEXT_IO,  A,  C,  CALENDAR; 

package  B  is 

procedure  DO_DIR; 

procedure  GET_DATA; 

end  B; 


— NAME 
— DATE 
—REVISED 
— TITLE 
— DESCRIPTION 


J.  Bonsignore,  Jr. 

22  Jan,  1991 

B.ADB 

Package  body  for  the  B  package 


package  body  B  is 

procedure  GET_DATA  is 

—  Opens  the  Data  file  containing  terrain  information  and  gets 

—  the  array  dimensions.  It  also  takes  as  input  the  starting 

—  and  goal  coordinates. 

FILE_NAME  :  STRING  (1..12); 

NAME  LEN  :  INT  TYPE; 
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begin 

put  ("Enter  the  name  of  data  file:  "); 
get_line  (FILE_NAME,  NAME_LEN) ; 

FILE_NAME  ( (NAME_LEN  +  1)..12)  :=  (others  =>  '  '); 
FILE_NAME  (9.. 12)  :=  ".DAT"; 

OPEN  (DATA_FILE,  MODE  =>  IN_FILE,  NAME  =>  FILE_NAME) ; 
INT_I 0 . ge t  ( DATA_F I LE ,  MAX_ROW ) ; 

INT_1 0 . ge t  ( DATA_F I LE ,  MAX_COL ) ; 

INT_IO.get  (DATA_FILE,  MAX_DEP) ; 

INT_IO.get  (DATA_FILE,  MAX_HDG) ; 

NEW_LINE; 

put  ("Enter  the  starting  row:  "); 

INT_I0 . get  (START ( 1 ) ) ; 

NEW_LINE; 

put  ("Enter  the  starting  col:  "); 

INT_IO.get  (START(2)); 

NEW_LINE; 

put  ("Enter  the  starting  dep:  "); 

INT_IO . get  ( START ( 3 ) ) ; 

NEW_LINE; 

put  ("Enter  the  starting  hdg:  "); 

INT_IO . get  ( START ( 4 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  row:  ") ; 

INT_IO . get  (GOAL ( 1 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  col:  "); 

INT_IO.get  (G0AL(2)); 

NEW_LINE; 

put  ("Enter  the  goal  dep:  "); 

INT_IO . get  (GOAL ( 3 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  hdg:  "); 

INT_IO . get  (GOAL (4 ) ) ; 

ACTIVE  :=  new  LIST; 

ACTIVE.LOC  :=  GOAL; 
end  GET_DATA; 

procedure  READ_TER  (N_ARRAy  :  in  out  NODE_ARRAY; 

D_FILE  :  in  out  FILE_TYPE)  is 

Reads  in  the  terrain  data  from  the  file  and  initializes  the 
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N  ARRAY. 


begin 


DEP, 


for  ROW  in  l..MAX_ROW  loop 
for  COL  in  l..MAX__COL  loop 

for  DEP  in  l..MAX_DEP  loop 
for  HDG  in  l..MAX_HDG  loop 
INT_IO.get  (D_FILE,  N_ARRAY(ROW,  COL, 

HDG) .STATE) ; 


end  loop; 
end  loop; 
end  loop; 
end  loop; 
close  (D_FILE); 
end  READ_TER; 

procedure  FREE  is  new  UNCHECKED_DEALLOCATION  (LIST, 
LIST  PTR); 


—  Used  to  free  old  memory  space. 


procedure  FIND_MOVES  (N_ARRAy  :  in  out  NODE_ARRAY)  is 

—  Using  the  REVERSE  heading  of  the  node  being  processed, 

—  FIND_MOVES  determines  which  nodes  can  legally  move  into 

—  it.  This  is  OPPOSITE  from  the  other  search  methods.  Again 

—  procedures  in  the  C  paclcage  (just  lilce  THE_MOVE)  are 
called  to  process  the  individual  nodes. 


HDG  :  INT_TYPE  :=  ACTIVE. LOC (4) ; 
L  :  LOC_ARRAY  :=  ACTIVE. LOC; 
NL  :  LOC  ARRAY  :=  ACTIVE. LOC; 


begin 

while  ACTIVE  /=  null  loop 
HDG  :=  ACTIVE.L0C(4) ; 

L  :=  ACTIVE. LOC; 

NL  :=  ACTIVE. LOC; 
case  HDG  is 

when  1  => 

S  (L,  NL,  N_ARRAY) ; 
NL  :=  L; 
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US  (L, 

NL, 

N_ARRAY)  ; 

NL  :  = 

L; 

DS  (L, 

NL, 

N_ARRAY) ; 

NL  :  = 

L; 

NL(4) 

•  s 

• 

4; 

SE  (L, 

NL, 

N  ARRAY) ; 

NL(1.  . 

3) 

•  22 

• 

L(1..3); 

U  SE  (L, 

NL 

,,  N  ARRAY)  ; 

NL  (1 .  . 

3) 

•  — 
• 

L(l.  .3)  ; 

DSE  (L 

NL, 

N_ARRAY) ; 

NL(1.  . 

3) 

•  ^ 
• 

L(l.  .3)  ; 

NL(4) 

•  ~ 
• 

2; 

SW  (L, 

NL, 

N  ARRAY)  ; 

NL<1. . 

3) 

• 

• 

L(1..3); 

USW  (L 

NL, 

N_ARRAY) ; 

NL(1. . 

3) 

• 

• 

L(l.  .3)  ; 

DSW  (L 

'0 

NL, 

N  ARRAY)  ; 

when  2  => 

W  (L,  NL,  N_ARRAY); 

NL  :=  L; 

UW  (L,  NL,  N_ARRAY) ; 
NL  ;=  L; 

DW  (L,  NL,  N_ARBAY) ; 
NL  ;=  L; 

NL(4)  :=  3; 

NW  (L,  NL,  N_ARRAY) ; 
NL(1.  .3)  :=  L(l.  .3)  ; 
UNW  (L,  NL,  N_ARRAY) ; 
NL(1.  .3)  :=  L(l.  .3)  ; 
DNW  (L,  NL,  N_ARRAY) ; 
NL  :=  L; 

NL(4)  :=  1; 

SW  (L,  NL,  N_ARRAY) ; 
NL(1.  .3)  ;=  L(l.  .3)  ; 
USW  (L,  NL,  N_ARRAY) ; 
NL(1.  .3)  ;=  L(l.  .3)  ; 
DSW  (L,  NL,  N_ARRAY) ; 

when  3  => 

N  (L,  NL,  N_ARRAY) ; 

NL  ;=  L; 

UN  (L,  NL,  N  ARRAY) ; 
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NL  :=  L; 

DN  (L,  NL,  N_ARRAY) ; 
NL  :=  L; 

NL(4)  :=  2; 

NW  (L,  NL,  N_ARRAY) ; 
NL(1..3)  :=  L(1..3); 
UNW  (L,  NL,  N_ARRAY) ; 
NL(1..3)  :=  L(1..3); 
DNW  (L,  NL,  N_ARRAY) ; 
NL  :=  L; 

NL(4)  :=  4; 

NE  (L,  NL,  N_ARRAY) ; 
NL(1..3)  :=  L(1..3); 
UNE  (L,  NL,  N_ARRAY); 
NL(1..3)  :=  L(1..3); 
DNE  (L,  NL,  N  ARRAY) ; 


when  4  => 


E  (L, 

NL,  N_ARRAY) ; 

NL  :  = 

L; 

UE  (L, 

NL, 

N_ARRAY)  ; 

NL  :  = 

L; 

DE  (L, 

NL, 

N_ARRAY) ; 

NL 

L; 

NL(4) 

:=  3; 

NE  (L, 

NL, 

N  ARRAY)  ; 

NL(1.  . 

3)  :  = 

L(1..3); 

UNE  (L 

„  NL, 

N  ARRAY) ; 

NL(1.  . 

3)  :  = 

L(1..3); 

ONE  (L 

,,  NL, 

N_ARRAY) ; 

NL  ;* 

L; 

NL(4) 

•=  1  • 

SE  (L, 

NL, 

N  ARRAY) ; 

NL(1.. 

3)  ;  = 

L(1..3); 

U_SE  (L,  NL 

,  N  ARRAY) ; 

NL(1.  . 

3)  :  = 

L(1..3); 

DSE  (L 

,  NL, 

N_ARRAY)  ; 

when  others  => 
null; 


end  case; 

CLEAR  :*  ACTIVE; 


96 


ACTIVE  :=  ACT I VE. NEXT; 

CLEAR. NEXT  ;=  null; 

FREE (CLEAR) ; 
end  loop; 
end  FIND_MOVES; 

procedure  P_PATH  is 

Processes  the  PATH  list  for  printing. 

P_TAIL  :  LIST_PTR  :=  PATH; 

begin 

loop 

put  ( '  ( ' )  ; 

INT_1 0 . put  ( P_TAI L . LOC  ( 1 ) ) ; 

INT_IO . put  (P_TAIL . LOC (2 ) ) ; 

INT_IO.put  (P_TAIL.LOC (3) ) ; 

INT_IO . put  (P_TAIL . LOC ( 4 ) ) ; 
put  (' )  ' ) ; 

NEW_LINE; 

exit  when  P_TAIL.LOC  =  GOAL; 

P_TAIL  :=  P_TAIL.NEXT; 
end  loop; 
end  P_PATH; 

procedure  FIND_PATH  (N_ARRAY  :  in  out  NODE_ARRAY)  is 

-  Used  to  process  the  PATH  list  adding  nodes  as  the  vectors 
are  traced. 

F_TAIL  :  LIST_PTR; 

begin 

F_TAIL  :=  new  LIST; 

F_TAIL.LOC  :=  START; 

PATH  :=  F_TAIL; 
loop 

exit  when  F_TAIL.LOC  =  GOAL; 

F_TAIL.NEXT  :=  new  LIST; 

F_TAIL. NEXT. LOC  ;=  N_ARRAY (F_TAIL.LOC (1) , F_TAIL.LOC (2) , 

F_TAIL . LOC ( 3 ) , F_TAI L . LOC ( 4 ) ) . NEXT ; 
F  TAIL  :=  F  TAIL. NEXT; 
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end  ]'op; 
end  FIND  PATH 


procedure  DO_DIR  is 

—  Creates  the  N_ARRAY  dynamically  and  calls  the  major 

—  procedures  for  the  search.  Some  timing  constructs  are 

—  added  for  evaluation  purposes. 

N_ARRAY  :  NODE_ARRAY ( 1 . . MAX_ROW, 1 . . MAX_COL, 

1..MAX  DEP,1..MAX  HDG) ; 


begin 

START_TIME  :=  CLOCK; 

READ_TER  (N_ARRAY,  DATA_FILE) ; 
FIND_MOVES  (N_ARRAY); 

FIND_PATH  (N_ARRAY) ; 

P_PATH; 

END_TIME  ;=  CLOCK; 

T_TIME  :=  END_TIME  -  START_TIME; 
FLOATIO.put  (FLOAT (T_TIME) ) ; 
put  ("  seconds."); 

NEW_LINE; 
end  DO_DIR; 

end  B; 
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"NAME 

—DATE 

—REVISED 

—TITLE 

—DESCRIPTION 

—CALLS 

—NOTES 


J.  Bonsignore,  Jr. 

22  Jan,  1991 

C.ADS 

The  package  containing  THE_MOVE  type 
procedures 

Although  similar  to  THE_MOVE  in  other 
programs,  the  procedures  are  somewhat 
different  due  to  the  "reverse"  nature  of  the 
search. 


with  TEXT_IO,  A; 
use  TEXT_IO,  A; 

package  C  is 

:  in  out  LOC_ARRAY; 

:  in  out  LOC_ARRAY; 

:  in  out  NODE_ARRAY; 
:  in  out  INT  TYPE) ; 


procedure  A_AND_A  (L 

NL 

N_ARRAY 

I 


procedure  N  (L  ;  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  ARRAY) ; 


procedure  NE  (L 
NL 

N_ARRAY 

procedure  E  (L 
NL 

N_ARRAY 

procedure  SE  (L 
NL 

N_ARRAY 

procedure  S  (L 
NL 

N  ARRAY 


in  out  LOC_ARRAY; 
in  out  LOC_ARRAY; 
in  out  NODE_ARRAY) 

in  out  LOC_ARRAY; 
in  out  LOC_ARRAY; 
in  out  NODE_ARRAY) ; 

in  out  LOC_ARRAY; 
in  out  LOC_ARRAY; 
in  out  NODE_ARRAY) 

in  out  LOC_ARRAY; 
in  out  LOC_ARRAY; 
in  out  NODE  ARRAY) ; 
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procedure 

SW 

(L 

in  out  LOC_ARRAY; 

NL  : 

in  out  LOC_ARRAY; 

N_ARRAY  ; 

in  out  NODE_ARRAY) ; 

procedure 

W 

(L  : 

in  out  LOC_ARRAY; 

NL  : 

in  out  LOC_ARRAY; 

N_ARRAY  : 

in  out  NODE_ARRAY) ; 

procedure 

NW 

(L  : 

in  out  LOC_ARRAY; 

NL  : 

in  out  LOC_ARRAY; 

N_ARRAY  : 

in  out  NODE_ARRAY) ; 

- 

procedure 

UN 

(L  : 

in  out  LOC_ARRAY; 

NL  ; 

in  out  LOC_ARRAY; 

N_ARRAY  : 

in  out  NODE_ARRAY) ; 

procedure 

UNE  (L 

:  in  out  LOC_ARRAY; 

NL 

;  in  out  LOC_ARRAY; 

N_ARRAY 

:  in  out  NODE_ARRAY) ; 

procedure 

TE 

(L  ; 

in  out  LOC_ARRAY; 

NL  ; 

in  out  LOC_ARRAY; 

N_ARRAY  ; 

in  out  NODE_ARRAY) ; 

procedure 

U_SE  (L 

:  in  out  LOC_ARRAY; 

NL 

:  in  out  LOC_ARRAY; 

N_ARRAY 

:  in  out  NODE_ARRAY) ; 

procedure 

US 

(L  ; 

in  out  LOC_ARRAY; 

NL  : 

in  out  LOC_ARRAY; 

N_ARRAY  ; 

in  out  NODE_ARRAY) ; 

procedure 

USW 

(L 

in  out  LOC_ARRAY; 

% 

NL 

in  out  LOC_ARRAY; 

N_ARRAY 

in  out  NODE_ARRAY) ; 

procedure 

UW 

(L 

in  out  LOC_ARRAY; 

NL  : 

in  out  LOC_ARRAY; 

N__ARRAY  ; 

in  out  NODE_ARRAY) ; 

procedure 

UNW 

(L  : 

in  out  LOC_ARRAY; 

NL  : 

in  out  LOC_ARRAY; 

100 

N_ARRAY  :  in  out  NODE_ARRAy) ; 

procedure  DN  (L  ;  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY) ; 

procedure  DNE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY) ; 

procedure  DE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY) ; 

procedure  DSE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY) ; 

procedure  DS  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  ;  in  out  NODE_ARRAY) ; 

procedure  DSW  (L  :  in  out  LOC_ARRAY; 

NL  ;  in  out  LOCJVKRAY; 

N_ARRAY  ;  in  out  NODE_ARRAY) ; 

procedure  DW  (L  :  in  out  LOC_ARRAY; 

NL  ;  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY) ; 

procedure  DNW  (L  :  in  out  LOC_ARRAY; 

NL  ;  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY) ; 

end  C; 


— NAME  :  J.  Bonsignore,  Jr. 

—DATE  :  22  Jan,  1991 

— REVISED 

—TITLE  :  C.ADS 

— DESCRIPTION  ;  The  package  body  for  the  C  package 
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package  body  C  is 


procedure  A_AND_A  (L 

NL 

N_ARRAY 

I 


:  in  out  LOC_ARRAy; 

:  in  out  LOC_ARRAY; 

:  in  out  NODE_ARRAY; 

:  in  out  INT  TYPE)  is 


-  Analyzes  and  assigns  the  legal  nodes  to  the  ACTIVE  list  and 
sets  the  various  attributes  in  the  N  ARRAY  node. 


begin 

if  N_ARRAY(NL(1) ,  NL(2),  NL(3),  NL (4)). STATE  =  0  then 
if  N_ARRAY(NL(1)  ,  NL(2),  NL(3),  NL(4)).DIST  =  0 
then 

if  ACTIVE. NEXT  =  null  then 
TAIL  :=  new  LIST; 

TAIL.LOC  :=  NL; 

ACTIVE. NEXT  :=  TAIL; 

else 

TAIL. NEXT  :=  new  LIST; 

TAIL  :=  TAIL.NEXT; 

TAIL.LOC  NL; 

end  if; 

N_ARRAY(NL(1)  ,NL(2)  ,NL(3)  ,NL(4)  )  .NEXT  :=  L; 
N_ARRAY(NL(1)  ,NL(2)  ,NL(3)  ,NL(4) )  .INC  :=  I; 
N_ARRAY(NL(1)  ,NL(2)  ,NL(3)  ,NL(4)  )  .DIST  :  = 
N_ARRAY(L(1)  ,L(2)  ,L(3)  ,L(4)  )  .DIST  +  I; 
end  if; 
end  if; 
end  A  AND  A; 


—  The  following  procedures  all  determine  the  coordinates  for 

—  the  given  move  based  on  the  current  node  coordinates. 

Calls  the  A_AND_A  procedure. 

procedure  N  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  >1  then 
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end  N 


NL(1)  :=  NL(1)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  CARD_COST) ; 
end  if; 


procedure  NE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  >1  and  L(2)  <  MAX_COL  then 
NL(1)  ;=  NL(1)  -  1; 

NL(2)  :=  NL(2)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  NE; 

procedure  E  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(2)  <  MAX_COL  then 
NL(2)  :»  NL(2)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  CARD_COST) ; 
end  if; 

end  E; 

procedure  SE  (L  :  in  out  LOC_ARRAY; 

NL  ;  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  <  MAX_ROW  and  L(2)  <  MAX_COL  then 
NL(1)  :=  NL(1)  +  1; 

NL(2)  :=  NL(2)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  SE; 

procedure  S  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  ;  in  out  NODE  ARRAY)  is 
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begin 


if  L(l)  <  MAX_ROW  then 
NL(1)  :=  NL(1)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  CARD_COST) 
end  if; 

end  S; 

procedure  SW  (L  :  in  out  LOC_ARRAY; 

NL  ;  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  <  MAX_ROW  and  L(2)  >1  then 
NL(1)  :=  NL(1)  +  1; 

NL(2)  :=  NL(2)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) 
end  if; 

end  SW; 

procedure  W  (L  :  in  out  LOC_ARRAY; 

NL  ;  in  out  LOC_ARPAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(2)  >1  then 
NL{2)  :=  NL(2)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  CARD_COST) 
end  if; 

end  W; 

procedure  NW  (L  ;  in  out  LOC_ARRAY; 

NL  ;  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  >1  and  L(2)  >1  then 
NL(1)  :=  NL(1)  -  1; 

NL(2)  :=  NL(2)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) 
end  if; 

end  NW; 
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procedure  UN  (L  :  in  out  LOC_ARRAy; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  ARRAY)  is 


begin 

if  L(l)  >1  and  L(3)  >1  then 
NL(1)  :=  NL(1)  -  1; 

NL(3)  :=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  UN; 

procedure  UNE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  >1  and  L(2)  <  MAX_COL  and  L(3) 
NL(1)  :=  NL(1)  -  1; 

NL(2)  ;=  NL(2)  +  1; 

NL(3)  :=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  UNE; 

procedure  UE  (L  ;  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  ARRAY)  is 


begin 

if  L(2)  <  MAX_COL  and  L(3)  >1  then 
NL(2)  :=  NL(2)  +  1; 

NL(3)  :=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  UE; 

procedure  U_SE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  ARRAY)  is 


begin 

if  L(l)  <  MAX  ROW  and  L(2)  <  MAX  COL  and 


>  1  then 


L(3)  >  1 
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then 


NL(1)  ;=  NL(1)  +  1; 

NL(2)  :=  NL(2)  +  1; 

NL(3)  :=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  U_SE; 

procedure  US  (L  :  in  out  LOC_ARRAy; 

NL  ;  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  ARRAY)  is 


begin 

if  L(l)  <  MAX_ROW  and  L(3)  >1  then 
NL(1)  ;=  NL(1)  +  1; 

NL(3)  :=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  US; 

procedure  USW  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  TUIRAY)  is 


begin 

if  L(l)  <  MAX_ROW  and  L(2)  >1  and  L(3)  > 
NL(1)  :=  NL(1)  +  1; 

NL(2)  ;=  NL(2)  -  1; 

NL(3)  ;=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  USW; 

procedure  UW  (L  ;  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  ;  in  out  NODE  ARRAY)  is 


begin 

if  L(2)  >  1  and  L(3)  >  1  then 
NL(2)  :=  NL(2)  -  1; 

NL(3)  :=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 


1  then 
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end  UW; 


procedure  UNW  (L  :  in  out  LOC_ARRAY; 

NL  ;  in  out  LOC_ARRAY; 

N_ARRAY  ;  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  >  1  and  L(2)  >  1  and  L(3)  >  1  then 
NL(1)  :=  NL(1)  -  1; 

NL(2)  :=  NL(2)  -  1; 

NL(3)  :=  NL(3)  -  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  UNW; 

procedure  DN  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  ARRAY)  is 


begin 

if  L(l)  >1  and  L{3)  <  MAX_DEP  then 
NL(1)  ;=  NL(1)  -  1; 

NL(3)  :=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  DN; 

procedure  DNE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  >1  and  L(2)  <  MAX_COL  and  L(3)  <  MAX_DEP 
then 

NL(1)  :=  NL(1)  -  1; 

NL(2)  :=  NL(2)  +  1; 

NL(3)  :=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  DNE; 


procedure  DE  (L  :  in  out  LOG  ARRAY; 
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begin 


NL  :  in  out  LOC_ARRAY; 

N  ARRAY  :  in  out  NODE  ARRAY)  is 


if  L(2)  <  MAX_COL  and  L(3)  <  MAX_DEP  then 
NL(2)  ;=  NL(2)  +  1; 

NL(3)  :=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  DE; 


procedure  DSE  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  <  MAX_ROW  and  L(2)  <  MAX_COL  and  L(3)  < 
MAX_DEP  then 
NL(1)  :=  NL(1)  +  1; 

NL(2)  :=  NL(2)  +  1; 

NL(3)  ;=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  DSE; 

procedure  DS  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  <  MAX_ROW  and  L(3)  <  MAX_DEP  then 
NL(1)  :=  NL(1)  +  1; 

NL(3)  :=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  DS; 

procedure  DSW  (L  ;  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  ;  in  out  NODE_ARRAY)  is 

begin 
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if  L(l)  <  MAX_ROW  and  L(2)  >1  and  L(3)  <  MAX_DEP 

then 

NL(1)  :=  NL(1)  +  1; 

NL(2)  :=  NL(2)  -  1; 

NL(3)  :=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  DSW; 

procedure  DW  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N  ARRAY  ;  in  out  NODE  ARRAY)  is 


begin 

if  L(2)  >1  and  L(3)  <  MAX_DEP  then 
NL(2)  :=  NL(2)  -  1; 

NL(3)  :=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 

end  DW; 

procedure  DNW  (L  :  in  out  LOC_ARRAY; 

NL  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY)  is 

begin 

if  L(l)  >1  and  L(2)  >1  and  L(3)  <  MAX_DEP  then 
NL(1)  :=  NL(1)  -  l; 

NL(2)  :=  NL(2)  -  1; 

NL(3)  :=  NL(3)  +  1; 

A_AND_A  (L,  NL,  N_ARRAY,  DIAG_COST) ; 
end  if; 
end  DNW; 

end  C; 
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APPENDIX  G  (part  1) 


Tiible  1:  Data  Dictionary  for  the  RTA*  Search 


PACKAGE 

PROCEPURE 

VARIABLE 

TYPE 

PATHWP 

GET  DATA 

FILE.NAME 

STRING  (1..12) 

NAME_LEN 

INT_TYPE 

P  PATH 

NEXT_LOC 

LOC_ARRAY 

F  MOVES 

HEADING 

INT.TYPE  :=  ROOTJX)C  (4) 

ASTAR_COST 

INTEGER  ;*  999 

1  a 

ROW.OOST 

COL.COST 

DEP_COST 

HDG.COST 

NEW.OOST 

INTEGER  :=  0 

DO  SEARCH 

N.ARRAY 

NODE_ARRAY  (l..MAX_ROW, 

1.. MAX_OOL,‘ 

1.. MAX_DEP, 

1.. MAX_HDG) 

DATA  FLOW  DIAGRAM  for  the  RTA*  SEARCH  (part  2) 


til 


REAL-TIME  A*  SEARCH  CODE  (part  3) 


— NAME 

—DATE 

—REVISED 

—TITLE 

—DESCRIPTION 

— CALLS 


—NOTES 


J.  Bonsignore,  Jr. 

22  Jan,  1991 

RTA.ADA 

Main  procedure  for  the  RTA*  search 
GET_DATA  and  DO_SEARCH  in  another  PATH 
package  for 
the  RTA. 


with  TEXT_IO,  GLOBALS,  PATH; 
use  TEXT__IO,  GLOBALS,  PATH; 

procedure  RTA  is 

begin 

GET_DATA; 

DO_SEARCH; 
end  RTA; 
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— NAME  :  J.  Bonsignore,  Jr. 

"DATE  :  22  Jan,  1991 

—REVISED  : 

— TITLE  :  PATH. ADS 

— DESCRIPTION  :  Contains  the  major  procedures  for  the  RTA 
:  search 

"CALLS  : 

"NOTES  : 


with  TEXT_IO,  GLOBALS,  THE_MOVE,  UNCHECKED_DEALLOCATION; 
use  TEXT_IO,  GLOBALS,  THE_MOVE; 

package  PATH  is 

procedure  DO_SEARCH; 

procedure  GET_DATA; 

procedure  READ_TER  (N_ARRAY  ;  in  out  NODE_ARRAY) ; 
procedure  P_PATH  (N_ARRAY  :  in  out  NODE_ARBAY) ; 
end  PATH; 


— NAME 
— DATE 
—REVISED 
—TITLE 
—DESCRIPTION 


J.  Bonsignore,  Jr. 

22  Jan,  1991 

PATH.ADB 

Package  body  for  the  Path  package  used  for 
the  RTA  search. 


package  body  PATH  is 

procedure  GET_DATA  is 
—  SAME  AS  OTHER  PATH  PACKAGE. 
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FILE_NAME  ;  STRING  (1..12); 

NAME_LEN  :  INT_TYPE; 

begin 

put  ("Enter  the  name  of  data  file;  "); 
get_line  (FILE_NAME,  NAME_LEN) ; 

FILE_NAME  ( (NAME_LEN  +  1)-.12)  :=  (others  =>  '  '); 

FILE_NAME  (9.. 12)  :=  ".DAT"; 

OPEN  (DATA_FILE,  MODE  =>  IN_FILE,  NAME  =>  FILE_NAME) ; 

INT_IO.get  (DATA_FILE,  MAX_ROW) ;  < 

INT_IO.get  (DATA_FILE,  MAX_COL) ; 

INT_IO.get  (DATA_FILE,  MAX_DEP) ; 

INT_I 0 . get  ( DATA_F I LE ,  MAX_HDG ) ; 

NEW_LINE; 

put  ("Enter  the  starting  row;  "); 

INT_IO . get  (START ( 1 ) ) ; 

NEW_LINE; 

put  ("Enter  the  starting  col;  "); 

INT_IO . get  (START (2 ) ) ; 

NEW_LINE; 

put  ("Enter  the  starting  dep;  ") ; 

INT_IO.get  (START (3)); 

NEWSLINE; 

put  ("Enter  the  starting  hdg: 

INT_IO.get  (START (4)); 

NEW_LINE; 

put  ("Enter  the  goal  row; 

INT_IO.get  (GOAL(l)); 

NEW_LINE; 

put  ("Enter  the  goal  col;  "); 

INT_IO . get  (GOAL ( 2 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  dep;  ") ; 

INT_IO . get  (GOAL ( 3 ) ) ; 

NEW_LINE; 

put  ("Enter  the  goal  hdg;  ") ; 

INT_IO . get  (GOAL ( 4 ) ) ; 

WAVE  ;*  new  LIST; 

WAVE. LOG  ;*  START; 

WAVE. INC  ;=  0; 
end  GET_DATA; 

procedure  READ_TER  (N_ARRAy  ;  in  out  NODE_ARRAY)  is 
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SAME  AS  OTHER  PATH  PACKAGE. 


begin 

for  ROW  in  l..MAX_ROW  loop 
for  COL  in  l..MAX_COL  loop 

for  DEP  in  l..MAX_DEP  loop 
for  HDG  in  l..MAX_HDG  loop 
INT_IO.get  (DATA_FILE,  N_ARRAy (ROW,  COL, 

DEP,  HDG). STATE) 
N_ARRAy(ROW,  COL,  DEP,  HDG) .TEND_LEN  :=  0 
N_ARRAY(ROW,  COL,  DEP,  HDG) .PARENT  ;= 

(0,0,  0,0)  ; 

end  loop; 
end  loop; 
end  loop; 
end  loop; 

close  (DATA_FILE) ; 
end  READ_TER; 

procedure  P_PATH  (N_ARRAY  :  in  out  NODE_ARRAY)  is 
SAME  AS  OTHER  PATH  PACKAGE. 

NEXT_LOC  ;  LOC_ARRAY; 

begin 

if  GOAL_FOUND  then 
put  ( ' ( ' ) ; 

INT_IO.put  (GOAL(l)); 

INT_IO.put  (GOAL (2)); 

INT_IO.put  (GOAL (3)); 

INT_IO.put  (GOAL (4)); 
put  ( ' ) ' )  ; 
new__line; 

NEXT_LOC  :=  N_ARRAY(GOAL(l) ,  GOAL (2),  GOAL (3), 
GOAL (4) ) .PARENT; 
while  NEXT_LOC  /=  START  loop 
put  CO; 

INT_IO . put  (NEXT_LOC ( 1 ) ) ; 

INT_IO . put  (NEXT_LOC (2 ) ) ; 

INT_I 0 . put  (NEXT_LOC ( 3 ) ) ; 

INT_IO . put  (NEXT  LOC ( 4 ) ) ; 
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put  ( ' ) ' ) ; 

NEXT_LOC  : =  N_ARRAY (NEXT_LOC ( 1 ) ,  NEXT_LOC ( 2 ) 
NEXT_LOC (3) , 

NEXT_LOC ( 4 ) ) . PARENT ; 

NEW_LINE; 
end  loop; 
put  ( '  ( ' ) ; 

INT_IO . put  (START ( 1 ) ) ; 

INT_IO.put  (START (2) ) ; 

INT_IO.put  (START (3) ) ; 

INT_IO.put  (START (4)); 
put  ( ' )  ' ) ; 
new_line; 

INT_IO . put  (N_ARRAy  (GOAL ( 1 ) ,  GOAL ( 2 ) ,  GOAL ( 3 ) , 

GOAL ( 4 ) ) . TEND_LEN) ; 

new_line; 

else 

put  ("PATH  NOT  FOUND"); 
new_line; 
end  if; 
end  P_PATH; 

procedure  F_MOVES  (N_ARRAY  :  in  out  NODE__ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

SAME  AS  OTHER  PATH  PACKAGE. 

HEADING  :  INT_TYPE  :=  ROOT.LOC(4); 


begin 

case  HEADING  is 
when  1  => 

CHECK_UP_NW  (N_ARRAY,  ROOT) ; 
CHECK_UP_N  (N_ARRAY,  ROOT) ; 
CHECK_UP_NE  (N_ARRAY,  ROOT) ; 
CHECK_NW  (N_ARRAY,  ROOT) ; 
CHECK_N  (N_ARRAY,  ROOT) ; 
CHECK_NE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_N  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NE  (N_ARRAY,  ROOT) ; 

when  2  => 
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CHECK_UP_NE  (N_ARRAY,  ROOT) ; 
CHECK_UP_E  (N_ARRAY,  ROOT) ; 
CHECK_UP_SE  (N_ARRAY,  ROOT) ; 
CHECK_NE  (N_ARRAY,  ROOT) ; 
CHECK_E  (N_ARRAY,  ROOT) ; 
CHECK_SE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_NE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_E  <N_ARRAY,  ROOT) ; 
CHECK_DOWN_SE  (N_ARRAY,  ROOT) ; 

when  3  => 

CHECK_UP_SE  (N_ARRAY,  ROOT) ; 
CHECK_UP_S  (N_ARRAY,  ROOT) ; 
CHECK_UP_SW  (N_ARRAY,  ROOT) ; 
CHECK_SE  (N_ARRAY,  ROOT) ; 
CHECK_S  (N_ARRAY,  ROOT) ; 
CHECK_SW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_SE  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_S  (N_ARRAY,  ROOT) ; 
CHECK  DOWN  SW  (N  ARRAY,  ROOT) ; 


when  4  => 

CHECK_UP_SW  (N_ARRAY,  ROOT) ; 
CHECK_UP_W  (N_ARRAY,  ROOT) ; 
CHECK_UP_NW  (N_ARRAY,  ROOT) ; 
CHECK_SW  (N_ARRAY,  ROOT); 
CHECK_W  (N_ARRAY,  ROOT) ; 
CHECK_NW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_SW  (N_ARRAY,  ROOT) ; 
CHECK_DOWN_W  (N_ARRAY,  ROOT) ; 
CHECK  DOWN  NW  (N  ARRAY,  ROOT) ; 


when  others  => 
null; 


end  case; 
end  F_MOVES; 

procedure  FREE  is  new  UNCHECKED_DEALLOCATION  (LIST, 

LIST  PTR) ; 


—  SAME  AS  OTHER  PATH  PACKAGE. 
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procedure  F_FRONT  (N_ARRAy  :  in  out  NODE_ARRAY)  is 

This  procedure  makes  two  calls  to  the  F_MOVES  procedure. 
Each  call  extends  the  search  depth  an  additional  node 
distance.  For  further  frontier  nodes  subsequent  calls  to 
F_MOVES  can  be  made. 

begin 

F_MOVES  (N_ARRAY,  WAVE) ; 

WAVE  :=  NEW_WAVE; 

NEW_WAVE  :=  null; 
while  WAVE  /=  null  loop 
TRASH  :=  WAVE; 

F_MOVES  (N_ARRAY,  WAVE); 

WAVE  :=  WAVE. NEXT; 

FREE  (TRASH) ; 
end  loop; 
end  F_FRONT; 

procedure  PICK_NODE  (N_ARRAY  :  in  out  NODE_ARRAY)  is 

Estimates  the  cost  to  reach  the  GOAL  from  the  frontier 
nodes  and  picks  the  least  cost  frontier  node  for  further 
expansion.  This  is  currently  working  in  a  limited  manner . 
Absolute  values  must  be  used  during  the  substraction 
of  the  GOAL  from  the  LOG. 

ASTAR_COST  :  INTEGER  :=  999; 

procedure  LEAST_COST  (LOG  :  in  out  LIST_PTR; 

ASTAR_GOST  :  in  out  INTEGER; 
N_ARRAY  ;  in  NODE_ARRAY)  is 

Estimates  the  cost  to  the  GOAL  and  assigns  that  nodes 
coordinates  to  ASTAR_ 

GOST  if  it  is  less  then  previously  processed  nodes  cost. 


ROW 

GOST 

;  INTEGER 

0 

gol] 

"gost 

:  INTEGER 

= 

0 

DEP" 

^GOST 

:  INTEGER 

= 

0 

hdg] 

]C0ST 

:  INTEGER 

0 

new" 

"cost 

:  INTEGER 

= 

0 

118 


DEP_COST  +  HDG_COST; 
LOG. LOG (2) , 


begin 

ROW_GOST  :=  GOAL(l)  -  LOG.LOG(l); 

GOL_GOST  ; =  GOAL ( 2 )  -  LOG . LOG ( 2 ) ; 

DEP_GOST  :=  GOAL (3)  -  LOG. LOG (3); 

HDG_GOST  :=  GOAL (4)  -  LOG.LOG(4); 

NEW_GOST  1=  ROW_GOST  +  GOL_GOST  + 

+  N_ARRAy (LOG . LOG (1 ) , 

LOG . LOG ( 3 ) ,  LOG . LOG ( 4 ) ) . TEND_LEN ; 
if  NEW_GOST  <  ASTAR_GOST  then 
ASTAR_GOST  :=  NEW_GOST; 

WAVE  :=  new  LIST; 

WAVE.LOG  :=  NEW_WAVE.LOG; 
end  if; 

end  LEAST  GOST; 


begin 

while  NEW_WAVE  /=  null  loop 

LEAST_GOST  (NEW_WAVE,  ASTAR_GOST,  N_ARRAY) ; 
if  NEW_WAVE.LOG  =  GOAL  then 
GOAL_FOUND  ;=  TRUE; 
end  if; 

exit  when  GOAL__FOUND; 

NEW_WAVE  :=  NEW  JWAVE. NEXT; 
end  loop; 

P_NODE  (WAVE) ; 
end  PIGK_NODE; 

procedure  DO_SEARGH  is 

—  Galls  the  major  procedures  in  the  search  and  creates  the 
"  N_ARRAY. 

N_ARRAY  ;  NODE_ARRAY  (l..MAX_ROW,  l..MAX_GOL, 

1 . .MAX_DEP,  1 . .MAX_HDG) ; 

begin 

READ_TER  (N_ARRAY) ; 
while  not  GOAL_FOUND  loop 
F_FRONT  (N_ARRAY); 

P I GK_NODE  ( N_ARRAY ) ; 
while  NEW_WAVE  /=  null  loop 
TRASH  :=  NEW  WAVE; 
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NEWJWAVE  ;=  NEW_WAVE.NEXT; 

FREE  (TRASH) ; 
end  loop; 

NEW_WAVE  :=  null; 
end  loop; 

GOT^  :=  WAVE. LOG;  —  Just  for  testing  purposes! 
GOAL_FOUND  ;=  TRUE;  —  Just  for  testing  purposes! 
P_PATH  (N_ARRAY) ; 
end  DO_SEARCH; 

end  PATH; 
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— NAME  :  J.  Bonsignore,  Jr. 

—DATE  ;  22  Jan,  1991 

—REVISED  : 

—TITLE  ;  THE_MOVE.ADS 

— DESCRIPTION  :  Package  containing  the  procedures  for 

:  individual  node  processing. 

—CALLS 

—NOTES  : 


with  TEXT_IO,  GLOBALS; 
use  TEXT_IO,  GLOBALS; 

package  THE_MOVE  is 

procedure  NNC  (ELEMENT  :  in  LIST_PTR; 

HEAD  :  in  out  LIST_PTR; 

TAIL  :  in  out  LIST_PTR) ; 

procedure  GROW_TEND  (ELE  :  in  out  LIST_PTR; 

N_ARRAY  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST__PTR)  ; 

procedure  CK_STATE  (NEW_LOC  :  in  out  LOC_ARRAY; 

N_ARRAY  :  in  out  NODE_ARRAY; 

NEW_INC  ;  in  out  INT_TYPE; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_N  (N_ARRAY  i  in  out  NODE_ARRAY; 

ROOT  ;  in  out  LIST_PTR) ; 

procedure  CHECK_UP_N  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST  PTR) ; 

procedure  CHECK_DOWN_N  {N_ARRAY  :  in  out  NODE_ARRAY; 
'  ROOT  ;  in  out  LIST_PTR) ; 

procedure  CHECK_NE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_NE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST  PTR) ; 
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procedure  CHECK_DOWN_NE  (N_ARRAY  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_E  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_E  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_E  (N_ARRAy  :  in  out  NODE_ARRAy;  • 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_SE  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  ;  in  out  LIST_PTR) ; 

procedure  CHECK_UP_SE  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_SE  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_S  (N__ARRAy  :  in  out  NODE_ARRAy; 

ROOT  ;  in  out  LIST_PTR) ; 

procedure  CHECK_UP__S  <N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST__PTR) ; 

procedure  CHECK_DOWN_S  (N_7jyRAy  ;  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_SW  (N_ARRAy  ;  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

% 

procedure  CHECK_UP_SW  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ;  » 

procedure  CHECK_DOWN_SW  <N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_W  (N_ARRAy  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_W  (N  ARRAY  :  in  out  NODE  ARRAY; 
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ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_W  (N_ARRAY  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_NW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_UP_NW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR) ; 

procedure  CHECK_DOWN_NW  (N_ARRAY  :  in  out  NODE_ARRAY 

ROOT  :  in  out  LIST_PTR) ; 

end  THE  MOVE; 


— NAME  :  J.  Bonsignore#  Jr. 

—DATE  :  22  Jan,  1991 

—REVISED  : 

— TITLE  ;  THE_MOVE . ADB 

— DESCRIPTION  :  Package  body  for  THE_MOVE  package. 


with  TEXT__IO,  GLOBALS; 
use  TEXT_IO,  GLOBALS; 

package  body  THE_MOVE  is 

procedure  NNC  (ELEMENT  ;  in  LIST_PTR; 

HEAD  :  in  out  LIST_PTR; 

TAIL  :  in  out  LIST_PTR)  is 

Creates  and  maintains  lists. 

begin 

if  HEAD  =  null  then 

HEAD  ;=  ELEMENT; 

TAIL  ;=  ELEMENT; 

else 

TAIL. NEXT  :=  ELEMENT; 

TAIL  :=  TAIL. NEXT; 

end  if; 
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end  NNC; 


procedure  GROW_TEND  (ELE  :  in  out  LIST_PTR; 

N_ARRAy  :  in  out  NODE_ARRAy/ 

ROOT  :  in  out  LIST_PTR)  is 

Expands  the  search  similar  to  that  in  the  Tendril  search. 

procedure  ASSIGN  (N_ARRAy  :  in  out  NODE_ARRAy; 

ELE  :  in  out  LIST_PTR; 

ROOT  :  in  out  LIST  PTR)  is 


begin 

if  N_ARRAy  (ELE. LOC(l) , ELE. L0C(2)  , ELE. LOGO)  , 
ELE.LOC(4) ) .TEND_LEN  =  0  then 
NNC  (ELE,  NEW_WAVE,  NW_TAIL) ; 
end  if; 

N_ARRAy (ELE.LOC(l) ,ELE.L0C(2) ,ELE.LOC(3) , 

ELE . LOG (4 ) ) .PARENT  : =  ROOT . LOG; 
N_ARRAy (ELE.LOC(l) ,ELE.LOC(2) , ELE. LOG (3) , 

ELE . LOG ( 4 ) ) . TEND_LEN  : =  ELE . INC  + 
N_ARRAy (ROOT. LOG (1) , ROOT. LOG (2) , ROOT. LOG (3) , 
ROOT , LOG  (4 ) )  . TEND__LEN; 
if  ELE. LOG  *  GOAL  then 
GOAL_FOUND  ;=  TRUE; 
end  if; 
end  ASSIGN; 


begin 

if  N_ARRAy (ELE.LOC(l) ,ELE.LOC(2) ,ELE.LOC(3) , 
ELE.LOC(4) ) .TEND_LEN  =  0  then 
ASSIGN  (N_ARRAy,  ELE,  ROOT) ; 
elsif  N_ARRAy (ELE.LOC(l) ,ELE.LOC(2) ,ELE.LOC(3) , 
ELE . LOG ( 4 ) ) . TEND_LEN  > 

(N^ARRAy (ROOT.LOC(l)  ,ROOT.LOC(2) ,ROOT.LOC(3) , 
ROOT . LOG ( 4 ) ) . TEND_LEN  +  ELE . INC )  then 
ASSIGN  (N_ARRAy,  ELE,  ROOT) ; 
end  if; 
end  GROW__TEND; 

procedure  CK_STATE  (NEW_LOC  :  in  out  LOC_ARRAy; 

N_ARRAy  :  in  out  NODE_ARRAy; 

NEW  INC  :  in  out  INT  TyPE; 
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ROOT  :  in  out  LIST_PTR)  is 

Similar  to  CK_STATE  in  the  Tendril  search. 

NEW  ELE  ;  LIST  PTR; 


begin 

i f  N_ARRAY ( NEW_LOC ( 1 ) ,  NEW_LOC (2) ,  NEW_LOC ( 3 ) , 
NEW_LOC(4) ) .STATE  =  0  then 
NEW_ELE  :=  new  LIST; 

NEW_ELE.LOC  :=  NEW_LOC; 

NEW_ELE.INC  :=  NEW_INC; 

GROW_TEND  (NEW_ELE,  N_ARRAY,  ROOT) ; 
end  if; 
end  CK_STATE; 

Following  procedures  are  similar  to  those  in  the  Tendril 
search's  THE_MOVE 
package . 

procedure  CHECK_N  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  ;  LOG  ARRAY  ;=  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  >  1  then 

NEW_LOG(l)  :=  NEW_LOG(l)  -  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  GARD_GOST,  ROOT) ; 
end  if; 
end  GHEGK_N; 

procedure  GHEGK_UP_N  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_L0G(1)  >  1  and  NEW_LOG(3)  >  1  then 
NEW_L0G(1)  :=  NEW_LOG(l)  -  1; 

NEW_L0G(3)  :=  NEW_LOG(3)  -  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 
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end  CHECK_UP_N; 

procedure  CHECK_DOWN_N  (N_ARRAY  :  in  out  NODE_ARRAy; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW__L0G(1)  >  1  and  NEW_LOG(3)  <  MAX_DEP  then 
NEW_LOG(l)  :=  NEW_LOG(l)  -  1; 

NEW_L0G(3)  :*  NEW_LOG(3)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_N; 

procedure  GHEGK_NE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  :  LOG_ARRAY  :=  ROOT.LOG; 

begin 

if  NEW__LOG(l)  >  1  and  NEW_L0G(2)  <  MAX_GOL  then 
NEW_LOG(l)  :=  NEW_LOG(l)  -  1; 

NEW_LOG(2)  :*=  NEW_LOG(2)  +  1; 

if  ROOT.LOG (4)  =  1  then 
NEW_LOG(4)  :=  2; 

else 

NEW_LOG(4)  :=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 
end  GHEGK_NE; 

procedure  GHEGK__UP_NE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  ;  LOG_ARRAY  ;=  ROOT.LOG; 

begin 

IF  NEW_L0G(1)  >  1  and  NEW_L0G(2)  <  MAX_GOL  and 
NEW_L0G(3)  >  1  then 

NEW_L0G(1)  :=  NEW_L0G(1)  -  1; 

NEW  LOG (2)  :*  NEW  LOG (2)  +  1; 
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NEW_L0C(3)  ;*  NEW_L0C(3)  -  1; 
if  R00T.L0C(4)  =  1  then 
NEW_L0C(4)  :=  2; 

else 

NEW_L0C(4)  :=  1; 

end  if; 

CK_STATE  (NEW_LOC,  N_ARRAy,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_UP_NE; 

procedure  CHECK_DOWN_NE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_L0G(1)  >  1  and  NEW_L0G(2)  <  MAX_GOL  and 
NEW_LOG(3)  <  MAX_DEP  then 

NEW_L0G(1)  :*  NEW_L0G(1)  -  1; 

NEW_L0G(2)  :=  NEW_LOG(2)  +  1; 

NEW_L0G<3)  :*  NEW_LOG(3)  +  1; 

if  ROOT.LOG (4)  =  1  then 
NEW_L0G(4)  :=  2; 

else 

NEW_L0G(4)  ;=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARBAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_NE; 

procedure  GHEGK_E  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  ;  in  out  LIST_PTR)  is 

NEW  LOG  ;  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(2)  <  MAX_COL  then 
NEW_LOG(2)  :=  NEW_LOG<2)  +  1; 

GK__STATE  (NEW_LOG,  N_ARRAY,  GARD_GOST,  ROOT)  ; 
end  if; 
end  GHEGK_E; 

procedure  GHEGK_UP_E  (N_ARRAY  :  in  out  NODE_ARRAY; 
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ROOT  :  in  out  LIST_PTR)  is 
NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_L0G(2)  <  MAX_GOL  and  NEW_LOG(3)  >  1  then 
NEW_LOG(2)  :=  NEW_LOG(2)  +  1; 

NEW_L0G(3)  ;=  NEW_LOG(3)  -  1; 

GK_STATE  (NEW_LOG,  N_ARRAy,  DIAG_GOST,  ROOT) ; 
end  if;  i 

end  GHEGK_UP_E; 

procedure  GHEGK_DOWN_E  (N_ARRAy  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(2)  <  MAX_GOL  and  NEW_LOG(3)  <  MAX_DEP 
then 

NEW_LOG(2)  ;=  NEW_LOG(2)  +  1; 

NEW_LOG(3)  :=  NEW_LOG(3)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN__E; 

procedure  GHEGK_W  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  ;=  ROOT.LOG; 


begin 

IF  NEW_LOG(2)  >  1  then 

NEW_L0G(2)  :=  NEW_LOG(2)  -  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  GARD_GOST,  ROOT) ; 
end  if; 
end  GHEGK_W; 

procedure  GHEGK_UP_W  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  ;  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 
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begin 


IF  NEW_L0C(2)  >  1  and  NEW_L0C(3)  >  1  then 
NEW_L0C(2)  ;=  NEW_L0C(2)  -  1; 

NEW_L0C(3)  :=  NEW_L0C(3)  -  1; 

CK_STATE  (NEW_LOC,  N_ARRAy,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_UP_W; 

procedure  CHECK_DOWN_W  {N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST  PTR)  is 

)  — 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(2)  >  1  and  NEW_LOG(3)  <  MAX_DEP  then 
NEW_LOG(2)  :=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  ;=  NEW_LOG(3)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_W; 

procedure  GHEGK_S  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :*  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  <  MAX_ROW  then 
NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  GARD_GOST,  ROOT) ; 
end  if; 
end  GHEGK_S; 

procedure  GHEGK_UP_S  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  ;  LOG_ARRAY  :*  ROOT.LOG; 

begin 

IF  NEW_LOG(l)  <  MAX_ROW  and  NEW_LOG(3)  >  1  then 
NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

NEW_LOG(3)  :=  NEW_LOG(3)  -  1; 

GK  STATE  (NEW  LOG,  N  ARRAY,  DIAG  GOST,  ROOT) ; 
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end  if; 

end  CHECK_UP_S; 

procedure  CHECK_DOWN_S  (N_ARRAy  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_L0G(1)  <  MAX_ROW  and  NEW_L0G(3)  <  MAX_DEP  < 

then 

NEW_L0G(1)  :=  NEW_LOG(l)  +  1; 

NEW_L0G(3)  :=  NEW_LOG(3)  +  1; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_S; 

procedure  GHEGK_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  ;  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_L0G(1)  <  MAX__ROW  and  NEW_LOG(2)  <  MAX_GOL 
then 

NEW__LOG(l)  :=  NEW__LOG(l)  +  1; 

NEW_LOG(2)  :=  NEW__LOG(2)  +  1; 
if  ROOT.LOG (4)  =  2  then 
NEW_L0G(4)  :=  3; 

else 

NEW_LOG(4)  :=  2; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ;  * 

end  if; 

end  GHEGK_SE;  • 

procedure  GHEGK_UP_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  ;  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW  LOG(l)  <  MAX  ROW  and  NEW  LOG (2)  <  MAX  GOL 
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and  NEW_L0C(3)  >  1  then 

NEW_L0C(1)  :=  NEW_L0C(1)  +  1; 

NEW_L0C(2)  :=  NEW_L0C(2)  +  1; 

NEW_L0C(3)  ;=  NEW_L0C(3)  -  1; 

if  ROOT. LOG (4)  =  2  then 
NEW_LOC{4)  :=  3; 

else 

NEW_LOC(4)  :=  2; 

end  if; 

CK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_COST,  ROOT) ; 
end  if; 

end  CHECK_U'’_SE; 

procedure  CHECK_DOWN_SE  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  <  MAX__ROW  and  NEW_LOG(2)  <  MAX_GOL 
and  NEW_LOG(3)  <  MAX_DEP  then 
NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

NEW_LOG(2)  NEW]^L0G(2)  +  1; 

NEW_L0G(3)  :*  NEw”lOG(3)  +  1; 

if  ROOT.LOG (4)  =  2  then 
NEW_L0G{4)  :=  3; 

else 

NEW_L0G(4)  :=  2; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_SE; 

procedure  GHEGK_SW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  :  LOG  ARRAY  ROOT.LOG; 


begin 

IF  NEW_L0G(1)  <  MAX_ROW  and  NEW_LOG(2)  >  1  then 
NEW_LOG(l)  :=  NEW_LOG(l)  +  1; 

NEW__LOG(2)  :=  NEW_LOG(2)  -  1; 
if  ROOT.LOG (4)  =  3  then 


131 


else 


NEW  LOG (4) 


4 


NEW_L0C(4)  :=  3; 

end  if; 

CK_STATE  (NEW_LOC,  N_ARRAY,  DIAG_COST,  ROOT) ; 
end  if; 
end  CHECK_SW; 

procedure  CHECK_UP_SW  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOC  :  LOC_ARRAY  :=  ROOT. LOG; 

begin 

IF  NEW_L0G(1)  <  MAX_ROW  and  NEW_LOG(2)  >  1  and 
NEW_LOG(3)  >  1  then 

NEW_L0G(1)  :=  NEW_L0G(1)  +  1; 

NEW_L0G(2)  :=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  :=  NEW_LOG(3)  -  1; 

if  ROOT.LOG (4)  =  3  then 
NEW_LOG(4)  :=  4; 

else 

NEW_LOG(4)  :=  3; 

end  if; 

GK__STATE  (NEW_LOG,  N_ARRAY,  DIAG__GOST,  ROOT)  ; 
end  if; 

end  GHEGK_UP_SW; 

procedure  GHEGK_DOWN_SW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  ;  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  <  MAX_ROW  and  NEW_LOG(2)  >  1  and 
NEW_LOG(3)  <  MAX_DEP  then 

NEW_L0G(1)  :=  NEW_L0G(1)  +  1; 

NEW_LOG(2)  :=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  ;=  NEW_LOG(3)  +  1; 

if  ROOT.LOG (4)  =  3  then 
NEW_LOG(4)  4; 

else 

NEW  LOG (4)  :=  3; 
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end  if; 

CK_STATE  (NEW_LOC,  N_ARRAy,  DIAG_COST,  ROOT) 
end  if; 

end  CHECK_DOWN_SW; 

procedure  CHECK_NW  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW  LOG  ;  LOG  ARRAY  :=  ROOT.LOG; 


begin 

IF  NEW_LOG(l)  >  1  and  NEW_L0G(2)  >  1  then 
NEW_L0G(1)  :=  NEW_LOG(l)  -  1; 

NEW_L0G(2)  :=  NEW_LOG(2)  -  1; 
if  ROOT.LOG (4)  =  1  then 
NEW_LOG(4)  :=  4; 

else 

NEW_LOG(4)  :=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) 
end  if; 
end  GHEGK_NW; 

procedure  GHEGK_UP_NW  (N_ARRAY  :  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOG  ;  LOG_ARRAY  :=  ROOT.LOG; 

begin 

IF  NEW_L0G(1)  >  1  and  NEW_L0G(2)  >  1  and 
NEW_L0G(3)  >  1  then 

NEW_LOG(l)  ;=  NEW_LOG(l)  -  1; 

NEW_LOG(2)  :=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  :=  NEW_LOG(3)  -  1; 

if  ROOT.LOG (4)  =  1  then 
NEW_LOG{4)  ;=  4; 

else 

NEW_LOG(4)  ;=  1; 

end  if; 

GK_STATE  (NEW_LOG,  N_ARRAY,  DIAG_GOST,  ROOT) 
end  if; 

end  GHEGK  UP  NW; 
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procedure  CHECK_DOWN_NW  (N_ARRAY  ;  in  out  NODE_ARRAY; 

ROOT  :  in  out  LIST_PTR)  is 

NEW_LOC  :  LOC_ARRAY  :=  ROOT. LOG; 


begin 

IF  NEW_LOC(l)  >  1  and  NEW_LOC(2)  >  1  and  NEW  LOGO) 
<  “ 

MAX_DEP  then 

NEW_LOG(l)  ;=  NEW_L0G(1)  -  1; 

NEW_L0G(2)  ;=  NEW_LOG(2)  -  1; 

NEW_LOG(3)  :=  NEW_L0G(3)  +  1; 

if  ROOT.LOG (4)  =  1  then 
NEW_L0G{4)  :=  4; 

else 

NEW_LOG(4)  :=  1; 

end  if; 

GK_STATE  (NEW_LOG/  N_ARRAY,  DIAG_GOST,  ROOT) ; 
end  if; 

end  GHEGK_DOWN_NW; 
end  THE  MOVE; 


« 
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